atafb_mfb.c
2.49 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
/*
* linux/drivers/video/mfb.c -- Low level frame buffer operations for
* monochrome
*
* Created 5 Apr 1997 by Geert Uytterhoeven
*
* This file is subject to the terms and conditions of the GNU General Public
* License. See the file COPYING in the main directory of this archive for
* more details.
*/
#include <linux/module.h>
#include <linux/string.h>
#include <linux/fb.h>
#include "atafb.h"
#include "atafb_utils.h"
/*
* Monochrome
*/
void atafb_mfb_copyarea(struct fb_info *info, u_long next_line,
int sy, int sx, int dy, int dx,
int height, int width)
{
u8 *src, *dest;
u_int rows;
if (sx == 0 && dx == 0 && width == next_line) {
src = (u8 *)info->screen_base + sy * (width >> 3);
dest = (u8 *)info->screen_base + dy * (width >> 3);
fb_memmove(dest, src, height * (width >> 3));
} else if (dy <= sy) {
src = (u8 *)info->screen_base + sy * next_line + (sx >> 3);
dest = (u8 *)info->screen_base + dy * next_line + (dx >> 3);
for (rows = height; rows--;) {
fb_memmove(dest, src, width >> 3);
src += next_line;
dest += next_line;
}
} else {
src = (u8 *)info->screen_base + (sy + height - 1) * next_line + (sx >> 3);
dest = (u8 *)info->screen_base + (dy + height - 1) * next_line + (dx >> 3);
for (rows = height; rows--;) {
fb_memmove(dest, src, width >> 3);
src -= next_line;
dest -= next_line;
}
}
}
void atafb_mfb_fillrect(struct fb_info *info, u_long next_line, u32 color,
int sy, int sx, int height, int width)
{
u8 *dest;
u_int rows;
dest = (u8 *)info->screen_base + sy * next_line + (sx >> 3);
if (sx == 0 && width == next_line) {
if (color)
fb_memset255(dest, height * (width >> 3));
else
fb_memclear(dest, height * (width >> 3));
} else {
for (rows = height; rows--; dest += next_line) {
if (color)
fb_memset255(dest, width >> 3);
else
fb_memclear_small(dest, width >> 3);
}
}
}
void atafb_mfb_linefill(struct fb_info *info, u_long next_line,
int dy, int dx, u32 width,
const u8 *data, u32 bgcolor, u32 fgcolor)
{
u8 *dest;
u_int rows;
dest = (u8 *)info->screen_base + dy * next_line + (dx >> 3);
for (rows = width / 8; rows--; /* check margins */ ) {
// use fast_memmove or fb_memmove
*dest++ = *data++;
}
}
#ifdef MODULE
MODULE_LICENSE("GPL");
int init_module(void)
{
return 0;
}
void cleanup_module(void)
{
}
#endif /* MODULE */
/*
* Visible symbols for modules
*/
EXPORT_SYMBOL(atafb_mfb_copyarea);
EXPORT_SYMBOL(atafb_mfb_fillrect);
EXPORT_SYMBOL(atafb_mfb_linefill);