13 #define FBDEV_PATH "/dev/fb0"
14 #define MAXWIDTH (1 << 12)
15 #define BPP sizeof(fbval_t)
18 static unsigned char *fb
;
19 static struct fb_var_screeninfo vinfo
;
20 static struct fb_fix_screeninfo finfo
;
24 return vinfo
.xres_virtual
* vinfo
.yres_virtual
* BPP
;
27 #define NLEVELS 1 << 8
30 unsigned short red
[NLEVELS
], green
[NLEVELS
], blue
[NLEVELS
];
32 int mr
= 1 << vinfo
.red
.length
;
33 int mg
= 1 << vinfo
.green
.length
;
34 int mb
= 1 << vinfo
.blue
.length
;
36 if (finfo
.visual
== FB_VISUAL_TRUECOLOR
)
39 for (i
= 0; i
< mr
; i
++)
40 red
[i
] = (65535 / (mr
- 1)) * i
;
41 for (i
= 0; i
< mg
; i
++)
42 green
[i
] = (65535 / (mg
- 1)) * i
;
43 for (i
= 0; i
< mb
; i
++)
44 blue
[i
] = (65535 / (mb
- 1)) * i
;
47 cmap
.len
= MAX(mr
, MAX(mg
, mb
));
53 ioctl(fd
, FBIOPUTCMAP
, &cmap
);
58 fd
= open(FBDEV_PATH
, O_RDWR
);
60 xerror("can't open " FBDEV_PATH
);
61 if (ioctl(fd
, FBIOGET_VSCREENINFO
, &vinfo
) == -1)
62 xerror("ioctl failed");
63 if (ioctl(fd
, FBIOGET_FSCREENINFO
, &finfo
) == -1)
64 xerror("ioctl failed");
65 fb
= mmap(NULL
, fb_len(), PROT_READ
| PROT_WRITE
, MAP_SHARED
, fd
, 0);
67 xerror("can't map the framebuffer");
71 void fb_set(int r
, int c
, fbval_t
*mem
, int len
)
73 long loc
= (c
+ vinfo
.xoffset
) * BPP
+
74 (r
+ vinfo
.yoffset
) * finfo
.line_length
;
75 memcpy(fb
+ loc
, mem
, len
* BPP
);
84 static fbval_t
color_bits(struct fb_bitfield
*bf
, fbval_t v
)
86 fbval_t moved
= v
>> (8 - bf
->length
);
87 return moved
<< bf
->offset
;
90 fbval_t
fb_color(unsigned char r
, unsigned char g
, unsigned char b
)
92 return color_bits(&vinfo
.red
, r
) |
93 color_bits(&vinfo
.green
, g
) |
94 color_bits(&vinfo
.blue
, b
);
107 static unsigned char *rowaddr(int r
)
109 return fb
+ (r
+ vinfo
.yoffset
) * finfo
.line_length
;
112 static unsigned long cache
[MAXWIDTH
];
113 void fb_box(int sr
, int sc
, int er
, int ec
, fbval_t val
)
116 int pc
= sizeof(cache
[0]) / sizeof(val
);
117 int cn
= MIN((ec
- sc
) / pc
+ 1, ARRAY_SIZE(cache
));
118 unsigned long nv
= val
;
119 for (i
= 1; i
< pc
; i
++)
120 nv
= (nv
<< (sizeof(val
) * 8)) | val
;
121 for (i
= 0; i
< cn
; i
++)
123 for (i
= sr
; i
< er
; i
++)
124 memcpy(rowaddr(i
) + sc
* BPP
, cache
, (ec
- sc
) * BPP
);
127 void fb_scroll(int sr
, int nr
, int n
, fbval_t val
)
129 memmove(rowaddr(sr
+ n
), rowaddr(sr
), nr
* finfo
.line_length
);
131 fb_box(sr
, 0, sr
+ n
, fb_cols(), val
);
133 fb_box(sr
+ nr
+ n
, 0, sr
+ nr
, fb_cols(), val
);