bee0d89463f755a4fc7a22a4d37966e618d148cb
2 * linux/drivers/video/iplan2p4.c -- Low level frame buffer operations for
3 * interleaved bitplanes à la Atari (4
4 * planes, 2 bytes interleave)
6 * Created 5 Apr 1997 by Geert Uytterhoeven
8 * This file is subject to the terms and conditions of the GNU General Public
9 * License. See the file COPYING in the main directory of this archive for
13 #include <linux/module.h>
14 #include <linux/string.h>
17 #include <asm/setup.h>
22 #include "atafb_utils.h"
24 void atafb_iplan2p4_copyarea(struct fb_info
*info
, u_long next_line
,
25 int sy
, int sx
, int dy
, int dx
,
26 int height
, int width
)
28 /* bmove() has to distinguish two major cases: If both, source and
29 * destination, start at even addresses or both are at odd
30 * addresses, just the first odd and last even column (if present)
31 * require special treatment (memmove_col()). The rest between
32 * then can be copied by normal operations, because all adjacent
33 * bytes are affected and are to be stored in the same order.
34 * The pathological case is when the move should go from an odd
35 * address to an even or vice versa. Since the bytes in the plane
36 * words must be assembled in new order, it seems wisest to make
37 * all movements by memmove_col().
44 u_int upwards
= (dy
< sy
) || (dy
== sy
&& dx
< sx
);
47 if (!((sx
^ dx
) & 15)) {
48 /* odd->odd or even->even */
51 src
= (u8
*)info
->screen_base
+ sy
* next_line
+ (sx
& ~15) / (8 / BPL
);
52 dst
= (u8
*)info
->screen_base
+ dy
* next_line
+ (dx
& ~15) / (8 / BPL
);
54 memmove32_col(dst
, src
, 0xff00ff, height
, next_line
- BPL
* 2);
64 l
= next_line
- w
* 4;
65 for (j
= height
; j
> 0; j
--) {
66 for (i
= w
; i
> 0; i
--)
68 s
= (u32
*)((u8
*)s
+ l
);
69 d
= (u32
*)((u8
*)d
+ l
);
73 memmove32_col(dst
+ width
/ (8 / BPL
), src
+ width
/ (8 / BPL
),
74 0xff00ff00, height
, next_line
- BPL
* 2);
76 src
= (u8
*)info
->screen_base
+ (sy
- 1) * next_line
+ ((sx
+ width
+ 8) & ~15) / (8 / BPL
);
77 dst
= (u8
*)info
->screen_base
+ (dy
- 1) * next_line
+ ((dx
+ width
+ 8) & ~15) / (8 / BPL
);
79 if ((sx
+ width
) & 15) {
82 memmove32_col(dst
, src
, 0xff00ff00, colsize
, -next_line
- BPL
* 2);
90 l
= next_line
- w
* 4;
91 for (j
= height
; j
> 0; j
--) {
92 for (i
= w
; i
> 0; i
--)
94 s
= (u32
*)((u8
*)s
- l
);
95 d
= (u32
*)((u8
*)d
- l
);
99 memmove32_col(dst
- (width
- 16) / (8 / BPL
),
100 src
- (width
- 16) / (8 / BPL
),
101 0xff00ff, colsize
, -next_line
- BPL
* 2);
104 /* odd->even or even->odd */
107 u32 pval
[4], v
, v1
, mask
;
110 src
= (u8
*)info
->screen_base
+ sy
* next_line
+ (sx
& ~15) / (8 / BPL
);
111 dst
= (u8
*)info
->screen_base
+ dy
* next_line
+ (dx
& ~15) / (8 / BPL
);
120 if ((sx
+ width
) & 15)
123 for (i
= height
; i
; i
--) {
128 pval
[0] = (*src32
++ << 8) & mask
;
129 pval
[1] = (*src32
++ << 8) & mask
;
131 pval
[0] = dst32
[0] & mask
;
132 pval
[1] = dst32
[1] & mask
;
135 for (j
= w
; j
> 0; j
--) {
138 *dst32
++ = pval
[0] | (v1
>> 8);
139 pval
[0] = (v
^ v1
) << 8;
142 *dst32
++ = pval
[1] | (v1
>> 8);
143 pval
[1] = (v
^ v1
) << 8;
147 dst32
[0] = (dst32
[0] & mask
) | pval
[0];
148 dst32
[1] = (dst32
[1] & mask
) | pval
[1];
156 u32 pval
[4], v
, v1
, mask
;
159 src
= (u8
*)info
->screen_base
+ (sy
- 1) * next_line
+ ((sx
+ width
+ 8) & ~15) / (8 / BPL
);
160 dst
= (u8
*)info
->screen_base
+ (dy
- 1) * next_line
+ ((dx
+ width
+ 8) & ~15) / (8 / BPL
);
165 if ((dx
+ width
) & 15)
172 for (i
= height
; i
; i
--) {
177 pval
[0] = dst32
[-1] & mask
;
178 pval
[1] = dst32
[-2] & mask
;
180 pval
[0] = (*--src32
>> 8) & mask
;
181 pval
[1] = (*--src32
>> 8) & mask
;
184 for (j
= w
; j
> 0; j
--) {
187 *--dst32
= pval
[0] | (v1
<< 8);
188 pval
[0] = (v
^ v1
) >> 8;
191 *--dst32
= pval
[1] | (v1
<< 8);
192 pval
[1] = (v
^ v1
) >> 8;
196 dst32
[-1] = (dst32
[-1] & mask
) | pval
[0];
197 dst32
[-2] = (dst32
[-2] & mask
) | pval
[1];
207 void atafb_iplan2p4_fillrect(struct fb_info
*info
, u_long next_line
, u32 color
,
208 int sy
, int sx
, int height
, int width
)
214 dest
= (u32
*)(info
->screen_base
+ sy
* next_line
+ (sx
& ~15) / (8 / BPL
));
216 u8
*dest8
= (u8
*)dest
+ 1;
218 expand8_col2mask(color
, cval
);
220 for (i
= height
; i
; i
--) {
221 fill8_col(dest8
, cval
);
228 expand16_col2mask(color
, cval
);
232 u32 off
= next_line
- rows
* BPL
* 2;
233 for (i
= height
; i
; i
--) {
234 d
= fill16_col(d
, rows
, cval
);
235 d
= (u32
*)((long)d
+ off
);
237 dest
+= rows
* BPL
/ 2;
242 u8
*dest8
= (u8
*)dest
;
244 expand8_col2mask(color
, cval
);
246 for (i
= height
; i
; i
--) {
247 fill8_col(dest8
, cval
);
253 void atafb_iplan2p4_linefill(struct fb_info
*info
, u_long next_line
,
254 int dy
, int dx
, u32 width
,
255 const u8
*data
, u32 bgcolor
, u32 fgcolor
)
260 u32 fgm
[4], bgm
[4], m
;
262 dest
= (u32
*)(info
->screen_base
+ dy
* next_line
+ (dx
& ~15) / (8 / BPL
));
264 fill8_2col((u8
*)dest
+ 1, fgcolor
, bgcolor
, *data
++);
270 data16
= (const u16
*)data
;
271 expand16_2col2mask(fgcolor
, bgcolor
, fgm
, bgm
);
273 for (rows
= width
/ 16; rows
; rows
--) {
275 m
= d
| ((u32
)d
<< 16);
276 *dest
++ = (m
& fgm
[0]) ^ bgm
[0];
277 *dest
++ = (m
& fgm
[1]) ^ bgm
[1];
280 data
= (const u8
*)data16
;
285 fill8_2col((u8
*)dest
, fgcolor
, bgcolor
, *data
);
289 MODULE_LICENSE("GPL");
291 int init_module(void)
296 void cleanup_module(void)
303 * Visible symbols for modules
306 EXPORT_SYMBOL(atafb_iplan2p4_copyarea
);
307 EXPORT_SYMBOL(atafb_iplan2p4_fillrect
);
308 EXPORT_SYMBOL(atafb_iplan2p4_linefill
);