rasops_bitops.h revision 1.23 1 1.23 rin /* $NetBSD: rasops_bitops.h,v 1.23 2019/08/02 04:39:09 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 #define NAME(name) NAME1(RASOPS_DEPTH, name)
36 1.23 rin #define NAME1(depth, name) NAME2(depth, name)
37 1.23 rin #define NAME2(depth, name) rasops ## depth ## _ ## name
38 1.23 rin
39 1.23 rin #if RASOPS_DEPTH == 1
40 1.23 rin #define PIXEL_SHIFT 0
41 1.23 rin #elif RASOPS_DEPTH == 2
42 1.23 rin #define PIXEL_SHIFT 1
43 1.23 rin #elif RASOPS_DEPTH == 4
44 1.23 rin #define PIXEL_SHIFT 2
45 1.23 rin #else
46 1.23 rin #error "Depth not supported"
47 1.23 rin #endif
48 1.23 rin
49 1.23 rin #define PIXEL_BITS RASOPS_DEPTH
50 1.23 rin #define COLOR_MASK __BITS(32 - PIXEL_BITS, 31)
51 1.23 rin
52 1.23 rin #if RASOPS_DEPTH != 1
53 1.23 rin /*
54 1.23 rin * Paint a single character. This function is also applicable to
55 1.23 rin * monochrome, but that in rasops1.c is much simpler and faster.
56 1.23 rin */
57 1.23 rin static void
58 1.23 rin NAME(putchar)(void *cookie, int row, int col, u_int uc, long attr)
59 1.23 rin {
60 1.23 rin struct rasops_info *ri = (struct rasops_info *)cookie;
61 1.23 rin struct wsdisplay_font *font = PICK_FONT(ri, uc);
62 1.23 rin int full, cnt, bit;
63 1.23 rin uint32_t fs, rs, fb, bg, fg, lmask, rmask, lbg, rbg, clr[2];
64 1.23 rin uint32_t height, width;
65 1.23 rin uint32_t *rp, *bp, *hp, tmp;
66 1.23 rin uint8_t *fr;
67 1.23 rin bool space;
68 1.23 rin
69 1.23 rin hp = NULL; /* XXX GCC */
70 1.23 rin
71 1.23 rin #ifdef RASOPS_CLIPPING
72 1.23 rin /* Catches 'row < 0' case too */
73 1.23 rin if ((unsigned)row >= (unsigned)ri->ri_rows)
74 1.23 rin return;
75 1.23 rin
76 1.23 rin if ((unsigned)col >= (unsigned)ri->ri_cols)
77 1.23 rin return;
78 1.23 rin #endif
79 1.23 rin
80 1.23 rin width = font->fontwidth << PIXEL_SHIFT;
81 1.23 rin col *= width;
82 1.23 rin height = font->fontheight;
83 1.23 rin rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale +
84 1.23 rin ((col >> 3) & ~3));
85 1.23 rin if (ri->ri_hwbits)
86 1.23 rin hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
87 1.23 rin ((col >> 3) & ~3));
88 1.23 rin col &= 31;
89 1.23 rin rs = ri->ri_stride;
90 1.23 rin
91 1.23 rin bg = ri->ri_devcmap[((uint32_t)attr >> 16) & 0xf];
92 1.23 rin fg = ri->ri_devcmap[((uint32_t)attr >> 24) & 0xf];
93 1.23 rin
94 1.23 rin /* If fg and bg match this becomes a space character */
95 1.23 rin if (uc == ' ' || __predict_false(fg == bg)) {
96 1.23 rin space = true;
97 1.23 rin fr = NULL; /* XXX GCC */
98 1.23 rin fs = 0; /* XXX GCC */
99 1.23 rin } else {
100 1.23 rin space = false;
101 1.23 rin fr = FONT_GLYPH(uc, font, ri);
102 1.23 rin fs = font->stride;
103 1.23 rin }
104 1.23 rin
105 1.23 rin if (col + width <= 32) {
106 1.23 rin /* Single word, only one mask */
107 1.23 rin
108 1.23 rin rmask = rasops_pmask[col][width & 31];
109 1.23 rin lmask = ~rmask;
110 1.23 rin
111 1.23 rin if (space) {
112 1.23 rin bg &= rmask;
113 1.23 rin while (height--) {
114 1.23 rin tmp = (*rp & lmask) | bg;
115 1.23 rin *rp = tmp;
116 1.23 rin DELTA(rp, rs, uint32_t *);
117 1.23 rin if (ri->ri_hwbits) {
118 1.23 rin *hp = tmp;
119 1.23 rin DELTA(hp, rs, uint32_t *);
120 1.23 rin }
121 1.23 rin }
122 1.23 rin } else {
123 1.23 rin clr[0] = bg & COLOR_MASK;
124 1.23 rin clr[1] = fg & COLOR_MASK;
125 1.23 rin while (height--) {
126 1.23 rin fb = be32uatoh(fr);
127 1.23 rin fr += fs;
128 1.23 rin tmp = 0;
129 1.23 rin for (bit = col; bit < col + width;
130 1.23 rin bit += PIXEL_BITS) {
131 1.23 rin tmp |= clr[(fb >> 31) & 1] >> bit;
132 1.23 rin fb <<= 1;
133 1.23 rin }
134 1.23 rin tmp = (*rp & lmask) | MBE(tmp);
135 1.23 rin *rp = tmp;
136 1.23 rin DELTA(rp, rs, uint32_t *);
137 1.23 rin if (ri->ri_hwbits) {
138 1.23 rin *hp = tmp;
139 1.23 rin DELTA(hp, rs, uint32_t *);
140 1.23 rin }
141 1.23 rin }
142 1.23 rin }
143 1.23 rin
144 1.23 rin /* Do underline */
145 1.23 rin if ((attr & WSATTR_UNDERLINE) != 0) {
146 1.23 rin DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
147 1.23 rin tmp = (*rp & lmask) | (fg & rmask);
148 1.23 rin *rp = tmp;
149 1.23 rin if (ri->ri_hwbits) {
150 1.23 rin DELTA(hp, -(ri->ri_stride << 1), uint32_t *);
151 1.23 rin *hp = tmp;
152 1.23 rin }
153 1.23 rin }
154 1.23 rin
155 1.23 rin return;
156 1.23 rin }
157 1.23 rin
158 1.23 rin /* Word boundary, two masks needed */
159 1.23 rin
160 1.23 rin lmask = ~rasops_lmask[col];
161 1.23 rin rmask = ~rasops_rmask[(col + width) & 31];
162 1.23 rin
163 1.23 rin if (lmask != -1)
164 1.23 rin width -= 32 - col;
165 1.23 rin full = width / 32;
166 1.23 rin width -= full * 32;
167 1.23 rin
168 1.23 rin if (space) {
169 1.23 rin lbg = bg & ~lmask;
170 1.23 rin rbg = bg & ~rmask;
171 1.23 rin
172 1.23 rin while (height--) {
173 1.23 rin bp = rp;
174 1.23 rin
175 1.23 rin if (lmask != -1) {
176 1.23 rin *bp = (*bp & lmask) | lbg;
177 1.23 rin bp++;
178 1.23 rin }
179 1.23 rin
180 1.23 rin for (cnt = full; cnt; cnt--)
181 1.23 rin *bp++ = bg;
182 1.23 rin
183 1.23 rin if (rmask != -1)
184 1.23 rin *bp = (*bp & rmask) | rbg;
185 1.23 rin
186 1.23 rin if (ri->ri_hwbits) {
187 1.23 rin memcpy(hp, rp, ((lmask != -1) + full +
188 1.23 rin (rmask != -1)) << 2);
189 1.23 rin DELTA(hp, rs, uint32_t *);
190 1.23 rin }
191 1.23 rin DELTA(rp, rs, uint32_t *);
192 1.23 rin }
193 1.23 rin } else {
194 1.23 rin clr[0] = bg & COLOR_MASK;
195 1.23 rin clr[1] = fg & COLOR_MASK;
196 1.23 rin
197 1.23 rin while (height--) {
198 1.23 rin bp = rp;
199 1.23 rin
200 1.23 rin fb = be32uatoh(fr);
201 1.23 rin fr += fs;
202 1.23 rin
203 1.23 rin if (lmask != -1) {
204 1.23 rin tmp = 0;
205 1.23 rin for (bit = col; bit < 32; bit += PIXEL_BITS) {
206 1.23 rin tmp |= clr[(fb >> 31) & 1] >> bit;
207 1.23 rin fb <<= 1;
208 1.23 rin }
209 1.23 rin *bp = (*bp & lmask) | MBE(tmp);
210 1.23 rin bp++;
211 1.23 rin }
212 1.23 rin
213 1.23 rin for (cnt = full; cnt; cnt--) {
214 1.23 rin tmp = 0;
215 1.23 rin for (bit = 0; bit < 32; bit += PIXEL_BITS) {
216 1.23 rin tmp |= clr[(fb >> 31) & 1] >> bit;
217 1.23 rin fb <<= 1;
218 1.23 rin }
219 1.23 rin *bp++ = MBE(tmp);
220 1.23 rin }
221 1.23 rin
222 1.23 rin if (rmask != -1) {
223 1.23 rin tmp = 0;
224 1.23 rin for (bit = 0; bit < width; bit += PIXEL_BITS) {
225 1.23 rin tmp |= clr[(fb >> 31) & 1] >> bit;
226 1.23 rin fb <<= 1;
227 1.23 rin }
228 1.23 rin *bp = (*bp & rmask) | MBE(tmp);
229 1.23 rin }
230 1.23 rin
231 1.23 rin if (ri->ri_hwbits) {
232 1.23 rin memcpy(hp, rp, ((lmask != -1) + full +
233 1.23 rin (rmask != -1)) << 2);
234 1.23 rin DELTA(hp, rs, uint32_t *);
235 1.23 rin }
236 1.23 rin
237 1.23 rin DELTA(rp, rs, uint32_t *);
238 1.23 rin }
239 1.23 rin }
240 1.23 rin
241 1.23 rin /* Do underline */
242 1.23 rin if ((attr & WSATTR_UNDERLINE) != 0) {
243 1.23 rin DELTA(rp, -(ri->ri_stride << 1), uint32_t *);
244 1.23 rin bp = rp;
245 1.23 rin if (lmask != -1) {
246 1.23 rin *bp = (*bp & lmask) | (fg & ~lmask);
247 1.23 rin bp++;
248 1.23 rin }
249 1.23 rin for (cnt = full; cnt; cnt--)
250 1.23 rin *bp++ = fg;
251 1.23 rin if (rmask != -1)
252 1.23 rin *bp = (*bp & rmask) | (fg & ~rmask);
253 1.23 rin if (ri->ri_hwbits) {
254 1.23 rin DELTA(hp, -(ri->ri_stride << 1), uint32_t *);
255 1.23 rin memcpy(hp, rp, ((lmask != -1) + full +
256 1.23 rin (rmask != -1)) << 2);
257 1.23 rin }
258 1.23 rin }
259 1.23 rin }
260 1.23 rin #endif /* RASOPS_DEPTH != 1 */
261 1.23 rin
262 1.1 ad /*
263 1.1 ad * Erase columns.
264 1.1 ad */
265 1.1 ad static void
266 1.11 cegger NAME(erasecols)(void *cookie, int row, int col, int num, long attr)
267 1.1 ad {
268 1.19 rin struct rasops_info *ri = (struct rasops_info *)cookie;
269 1.19 rin uint32_t lclr, rclr, clr;
270 1.18 rin uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
271 1.1 ad int height, cnt;
272 1.6 pk
273 1.18 rin hp = NULL; /* XXX GCC */
274 1.18 rin
275 1.6 pk #ifdef RASOPS_CLIPPING
276 1.1 ad if ((unsigned)row >= (unsigned)ri->ri_rows)
277 1.1 ad return;
278 1.1 ad
279 1.1 ad if (col < 0) {
280 1.1 ad num += col;
281 1.1 ad col = 0;
282 1.1 ad }
283 1.1 ad
284 1.19 rin if (col + num > ri->ri_cols)
285 1.1 ad num = ri->ri_cols - col;
286 1.6 pk
287 1.1 ad if (num <= 0)
288 1.1 ad return;
289 1.1 ad #endif
290 1.20 rin
291 1.1 ad col *= ri->ri_font->fontwidth << PIXEL_SHIFT;
292 1.1 ad num *= ri->ri_font->fontwidth << PIXEL_SHIFT;
293 1.1 ad height = ri->ri_font->fontheight;
294 1.17 rin clr = ri->ri_devcmap[((uint32_t)attr >> 16) & 0xf];
295 1.15 tsutsui rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + ((col >> 3) & ~3));
296 1.12 macallan if (ri->ri_hwbits)
297 1.18 rin hp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
298 1.12 macallan ((col >> 3) & ~3));
299 1.19 rin col &= 31;
300 1.19 rin
301 1.19 rin if (col + num <= 32) {
302 1.19 rin lmask = ~rasops_pmask[col][num & 31];
303 1.1 ad lclr = clr & ~lmask;
304 1.1 ad
305 1.1 ad while (height--) {
306 1.1 ad dp = rp;
307 1.15 tsutsui DELTA(rp, ri->ri_stride, uint32_t *);
308 1.1 ad
309 1.12 macallan tmp = (*dp & lmask) | lclr;
310 1.12 macallan *dp = tmp;
311 1.12 macallan if (ri->ri_hwbits) {
312 1.18 rin *hp = tmp;
313 1.18 rin DELTA(hp, ri->ri_stride, uint32_t *);
314 1.12 macallan }
315 1.1 ad }
316 1.1 ad } else {
317 1.19 rin lmask = rasops_rmask[col];
318 1.1 ad rmask = rasops_lmask[(col + num) & 31];
319 1.6 pk
320 1.1 ad if (lmask)
321 1.19 rin num = (num - (32 - col)) >> 5;
322 1.1 ad else
323 1.1 ad num = num >> 5;
324 1.6 pk
325 1.1 ad lclr = clr & ~lmask;
326 1.1 ad rclr = clr & ~rmask;
327 1.1 ad
328 1.1 ad while (height--) {
329 1.1 ad dp = rp;
330 1.1 ad
331 1.8 thorpej if (lmask) {
332 1.18 rin *dp = (*dp & lmask) | lclr;
333 1.8 thorpej dp++;
334 1.8 thorpej }
335 1.1 ad
336 1.1 ad for (cnt = num; cnt > 0; cnt--)
337 1.1 ad *dp++ = clr;
338 1.18 rin
339 1.18 rin if (rmask)
340 1.18 rin *dp = (*dp & rmask) | rclr;
341 1.18 rin
342 1.12 macallan if (ri->ri_hwbits) {
343 1.18 rin memcpy(hp, rp, ((lmask != 0) + num +
344 1.18 rin (rmask != 0)) << 2);
345 1.18 rin DELTA(hp, ri->ri_stride, uint32_t *);
346 1.12 macallan }
347 1.18 rin DELTA(rp, ri->ri_stride, uint32_t *);
348 1.1 ad }
349 1.1 ad }
350 1.1 ad }
351 1.1 ad
352 1.1 ad /*
353 1.1 ad * Actually paint the cursor.
354 1.1 ad */
355 1.1 ad static void
356 1.11 cegger NAME(do_cursor)(struct rasops_info *ri)
357 1.1 ad {
358 1.19 rin int height, row, col, num, cnt;
359 1.19 rin uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
360 1.18 rin
361 1.19 rin hp = NULL; /* XXX GCC */
362 1.6 pk
363 1.1 ad row = ri->ri_crow;
364 1.1 ad col = ri->ri_ccol * ri->ri_font->fontwidth << PIXEL_SHIFT;
365 1.1 ad height = ri->ri_font->fontheight;
366 1.1 ad num = ri->ri_font->fontwidth << PIXEL_SHIFT;
367 1.16 rin rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale +
368 1.16 rin ((col >> 3) & ~3));
369 1.12 macallan if (ri->ri_hwbits)
370 1.19 rin hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
371 1.12 macallan ((col >> 3) & ~3));
372 1.19 rin col &= 31;
373 1.6 pk
374 1.19 rin if (col + num <= 32) {
375 1.19 rin lmask = rasops_pmask[col][num & 31];
376 1.1 ad
377 1.1 ad while (height--) {
378 1.18 rin tmp = *rp ^ lmask;
379 1.18 rin *rp = tmp;
380 1.18 rin if (ri->ri_hwbits) {
381 1.19 rin *hp = tmp;
382 1.19 rin DELTA(hp, ri->ri_stride, uint32_t *);
383 1.12 macallan }
384 1.18 rin DELTA(rp, ri->ri_stride, uint32_t *);
385 1.12 macallan }
386 1.1 ad } else {
387 1.19 rin lmask = ~rasops_rmask[col];
388 1.1 ad rmask = ~rasops_lmask[(col + num) & 31];
389 1.1 ad
390 1.19 rin if (lmask != -1)
391 1.19 rin num = (num - (32 - col)) >> 5;
392 1.19 rin else
393 1.19 rin num = num >> 5;
394 1.19 rin
395 1.1 ad while (height--) {
396 1.1 ad dp = rp;
397 1.19 rin
398 1.19 rin if (lmask != -1) {
399 1.19 rin *dp = *dp ^ lmask;
400 1.19 rin dp++;
401 1.12 macallan }
402 1.18 rin
403 1.19 rin for (cnt = num; cnt; cnt--) {
404 1.19 rin *dp = ~*dp;
405 1.12 macallan dp++;
406 1.12 macallan }
407 1.1 ad
408 1.19 rin if (rmask != -1)
409 1.19 rin *dp = *dp ^ rmask;
410 1.19 rin
411 1.19 rin if (ri->ri_hwbits) {
412 1.19 rin memcpy(hp, rp, ((lmask != -1) + num +
413 1.19 rin (rmask != -1)) << 2);
414 1.19 rin DELTA(hp, ri->ri_stride, uint32_t *);
415 1.12 macallan }
416 1.20 rin
417 1.19 rin DELTA(rp, ri->ri_stride, uint32_t *);
418 1.1 ad }
419 1.1 ad }
420 1.1 ad }
421 1.1 ad
422 1.1 ad /*
423 1.4 ad * Copy columns. Ick!
424 1.1 ad */
425 1.1 ad static void
426 1.11 cegger NAME(copycols)(void *cookie, int row, int src, int dst, int num)
427 1.1 ad {
428 1.18 rin struct rasops_info *ri = (struct rasops_info *)cookie;
429 1.15 tsutsui int height, lnum, rnum, sb, db, cnt, full;
430 1.15 tsutsui uint32_t tmp, lmask, rmask;
431 1.18 rin uint32_t *sp, *dp, *srp, *drp, *dhp, *hp;
432 1.6 pk
433 1.18 rin dhp = hp = NULL; /* XXX GCC */
434 1.1 ad
435 1.1 ad #ifdef RASOPS_CLIPPING
436 1.1 ad if (dst == src)
437 1.1 ad return;
438 1.6 pk
439 1.1 ad /* Catches < 0 case too */
440 1.1 ad if ((unsigned)row >= (unsigned)ri->ri_rows)
441 1.1 ad return;
442 1.6 pk
443 1.1 ad if (src < 0) {
444 1.1 ad num += src;
445 1.1 ad src = 0;
446 1.1 ad }
447 1.1 ad
448 1.18 rin if (src + num > ri->ri_cols)
449 1.1 ad num = ri->ri_cols - src;
450 1.1 ad
451 1.1 ad if (dst < 0) {
452 1.1 ad num += dst;
453 1.1 ad dst = 0;
454 1.1 ad }
455 1.1 ad
456 1.18 rin if (dst + num > ri->ri_cols)
457 1.1 ad num = ri->ri_cols - dst;
458 1.6 pk
459 1.1 ad if (num <= 0)
460 1.1 ad return;
461 1.1 ad #endif
462 1.6 pk
463 1.1 ad cnt = ri->ri_font->fontwidth << PIXEL_SHIFT;
464 1.1 ad src *= cnt;
465 1.1 ad dst *= cnt;
466 1.1 ad num *= cnt;
467 1.1 ad row *= ri->ri_yscale;
468 1.1 ad height = ri->ri_font->fontheight;
469 1.4 ad db = dst & 31;
470 1.1 ad
471 1.6 pk if (db + num <= 32) {
472 1.4 ad /* Destination is contained within a single word */
473 1.15 tsutsui srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
474 1.15 tsutsui drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
475 1.12 macallan if (ri->ri_hwbits)
476 1.15 tsutsui dhp = (uint32_t *)(ri->ri_hwbits + row +
477 1.12 macallan ((dst >> 3) & ~3));
478 1.1 ad sb = src & 31;
479 1.1 ad
480 1.1 ad while (height--) {
481 1.1 ad GETBITS(srp, sb, num, tmp);
482 1.1 ad PUTBITS(tmp, db, num, drp);
483 1.12 macallan if (ri->ri_hwbits) {
484 1.12 macallan PUTBITS(tmp, db, num, dhp);
485 1.15 tsutsui DELTA(dhp, ri->ri_stride, uint32_t *);
486 1.12 macallan }
487 1.15 tsutsui DELTA(srp, ri->ri_stride, uint32_t *);
488 1.15 tsutsui DELTA(drp, ri->ri_stride, uint32_t *);
489 1.1 ad }
490 1.6 pk
491 1.1 ad return;
492 1.1 ad }
493 1.1 ad
494 1.4 ad lmask = rasops_rmask[db];
495 1.1 ad rmask = rasops_lmask[(dst + num) & 31];
496 1.4 ad lnum = (32 - db) & 31;
497 1.6 pk rnum = (dst + num) & 31;
498 1.6 pk
499 1.1 ad if (lmask)
500 1.21 rin full = (num - lnum) >> 5;
501 1.1 ad else
502 1.1 ad full = num >> 5;
503 1.1 ad
504 1.4 ad if (src < dst && src + num > dst) {
505 1.4 ad /* Copy right-to-left */
506 1.15 tsutsui bool sbover;
507 1.15 tsutsui int sboff;
508 1.15 tsutsui
509 1.15 tsutsui srp = (uint32_t *)(ri->ri_bits + row +
510 1.15 tsutsui (((src + num) >> 3) & ~3));
511 1.15 tsutsui drp = (uint32_t *)(ri->ri_bits + row +
512 1.15 tsutsui (((dst + num) >> 3) & ~3));
513 1.12 macallan if (ri->ri_hwbits)
514 1.15 tsutsui dhp = (uint32_t *)(ri->ri_hwbits + row +
515 1.15 tsutsui (((dst + num) >> 3) & ~3));
516 1.1 ad
517 1.15 tsutsui sb = src & 31;
518 1.15 tsutsui sbover = (sb + lnum) >= 32;
519 1.15 tsutsui sboff = (src + num) & 31;
520 1.15 tsutsui if ((sboff -= rnum) < 0) {
521 1.14 tsutsui srp--;
522 1.15 tsutsui sboff += 32;
523 1.4 ad }
524 1.6 pk
525 1.1 ad while (height--) {
526 1.1 ad sp = srp;
527 1.1 ad dp = drp;
528 1.6 pk
529 1.15 tsutsui if (rnum) {
530 1.15 tsutsui GETBITS(sp, sboff, rnum, tmp);
531 1.15 tsutsui PUTBITS(tmp, 0, rnum, dp);
532 1.1 ad }
533 1.1 ad
534 1.4 ad /* Now aligned to 32-bits wrt dp */
535 1.15 tsutsui for (cnt = full; cnt; cnt--) {
536 1.15 tsutsui --dp;
537 1.15 tsutsui --sp;
538 1.15 tsutsui GETBITS(sp, sboff, 32, tmp);
539 1.15 tsutsui *dp = tmp;
540 1.1 ad }
541 1.1 ad
542 1.1 ad if (lmask) {
543 1.15 tsutsui if (sbover)
544 1.15 tsutsui --sp;
545 1.15 tsutsui --dp;
546 1.4 ad GETBITS(sp, sb, lnum, tmp);
547 1.15 tsutsui PUTBITS(tmp, db, lnum, dp);
548 1.1 ad }
549 1.18 rin
550 1.18 rin if (ri->ri_hwbits) {
551 1.18 rin hp = dhp;
552 1.22 rin hp -= (lmask != 0) + full;
553 1.22 rin memcpy(hp, dp, ((lmask != 0) + full +
554 1.22 rin (rnum != 0)) << 2);
555 1.18 rin DELTA(dhp, ri->ri_stride, uint32_t *);
556 1.18 rin }
557 1.22 rin
558 1.22 rin DELTA(srp, ri->ri_stride, uint32_t *);
559 1.22 rin DELTA(drp, ri->ri_stride, uint32_t *);
560 1.1 ad }
561 1.1 ad } else {
562 1.4 ad /* Copy left-to-right */
563 1.15 tsutsui srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
564 1.15 tsutsui drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
565 1.12 macallan if (ri->ri_hwbits)
566 1.15 tsutsui dhp = (uint32_t *)(ri->ri_hwbits + row +
567 1.12 macallan ((dst >> 3) & ~3));
568 1.1 ad
569 1.1 ad while (height--) {
570 1.1 ad sb = src & 31;
571 1.1 ad sp = srp;
572 1.1 ad dp = drp;
573 1.6 pk
574 1.1 ad if (lmask) {
575 1.1 ad GETBITS(sp, sb, lnum, tmp);
576 1.1 ad PUTBITS(tmp, db, lnum, dp);
577 1.1 ad dp++;
578 1.6 pk
579 1.20 rin sb += lnum;
580 1.20 rin if (sb > 31) {
581 1.1 ad sp++;
582 1.1 ad sb -= 32;
583 1.1 ad }
584 1.1 ad }
585 1.6 pk
586 1.4 ad /* Now aligned to 32-bits wrt dp */
587 1.4 ad for (cnt = full; cnt; cnt--, sp++) {
588 1.1 ad GETBITS(sp, sb, 32, tmp);
589 1.1 ad *dp++ = tmp;
590 1.1 ad }
591 1.1 ad
592 1.1 ad if (rmask) {
593 1.1 ad GETBITS(sp, sb, rnum, tmp);
594 1.1 ad PUTBITS(tmp, 0, rnum, dp);
595 1.1 ad }
596 1.18 rin
597 1.18 rin if (ri->ri_hwbits) {
598 1.18 rin memcpy(dhp, drp, ((lmask != 0) + full +
599 1.18 rin (rmask != 0)) << 2);
600 1.18 rin DELTA(dhp, ri->ri_stride, uint32_t *);
601 1.18 rin }
602 1.18 rin
603 1.18 rin DELTA(srp, ri->ri_stride, uint32_t *);
604 1.18 rin DELTA(drp, ri->ri_stride, uint32_t *);
605 1.1 ad }
606 1.1 ad }
607 1.1 ad }
608 1.5 ad
609 1.23 rin #undef PIXEL_SHIFT
610 1.23 rin #undef PIXEL_BITS
611 1.23 rin #undef COLOR_MASK
612 1.23 rin
613 1.1 ad #endif /* _RASOPS_BITOPS_H_ */
614