11 #define MAXFBWIDTH (1 << 12)
12 #define BPP sizeof(fbval_t)
13 #define NLEVELS (1 << 8)
16 static unsigned char *fb
;
17 static struct fb_var_screeninfo vinfo
;
18 static struct fb_fix_screeninfo finfo
;
19 static int rl
, rr
, gl
, gr
, bl
, br
;
20 static int nr
, ng
, nb
;
22 static int fb_len(void)
24 return finfo
.line_length
* vinfo
.yres_virtual
;
27 static void fb_cmap_save(int save
)
29 static unsigned short red
[NLEVELS
], green
[NLEVELS
], blue
[NLEVELS
];
31 if (finfo
.visual
== FB_VISUAL_TRUECOLOR
)
34 cmap
.len
= MAX(nr
, MAX(ng
, nb
));
39 ioctl(fd
, save
? FBIOGETCMAP
: FBIOPUTCMAP
, &cmap
);
44 unsigned short red
[NLEVELS
], green
[NLEVELS
], blue
[NLEVELS
];
47 if (finfo
.visual
== FB_VISUAL_TRUECOLOR
)
50 for (i
= 0; i
< nr
; i
++)
51 red
[i
] = (65535 / (nr
- 1)) * i
;
52 for (i
= 0; i
< ng
; i
++)
53 green
[i
] = (65535 / (ng
- 1)) * i
;
54 for (i
= 0; i
< nb
; i
++)
55 blue
[i
] = (65535 / (nb
- 1)) * i
;
58 cmap
.len
= MAX(nr
, MAX(ng
, nb
));
64 ioctl(fd
, FBIOPUTCMAP
, &cmap
);
67 static void xerror(char *msg
)
73 static void xdie(char *msg
)
75 fprintf(stderr
, "%s\n", msg
);
79 static void init_colors(void)
81 nr
= 1 << vinfo
.red
.length
;
82 ng
= 1 << vinfo
.green
.length
;
83 nb
= 1 << vinfo
.blue
.length
;
84 rr
= 8 - vinfo
.red
.length
;
85 rl
= vinfo
.red
.offset
;
86 gr
= 8 - vinfo
.green
.length
;
87 gl
= vinfo
.green
.offset
;
88 br
= 8 - vinfo
.blue
.length
;
89 bl
= vinfo
.blue
.offset
;
94 fd
= open(FBDEV_PATH
, O_RDWR
);
96 xerror("can't open " FBDEV_PATH
);
97 if (ioctl(fd
, FBIOGET_VSCREENINFO
, &vinfo
) == -1)
98 xerror("ioctl failed");
99 if (ioctl(fd
, FBIOGET_FSCREENINFO
, &finfo
) == -1)
100 xerror("ioctl failed");
101 if ((vinfo
.bits_per_pixel
+ 7) >> 3 != BPP
)
102 xdie("fbval_t does not match framebuffer depth");
103 fcntl(fd
, F_SETFD
, fcntl(fd
, F_GETFD
) | FD_CLOEXEC
);
105 fb
= mmap(NULL
, fb_len(), PROT_READ
| PROT_WRITE
, MAP_SHARED
, fd
, 0);
106 if (fb
== MAP_FAILED
)
107 xerror("can't map the framebuffer");
112 void fb_set(int r
, int c
, fbval_t
*mem
, int len
)
114 long loc
= (c
+ vinfo
.xoffset
) * BPP
+
115 (r
+ vinfo
.yoffset
) * finfo
.line_length
;
116 memcpy(fb
+ loc
, mem
, len
* BPP
);
122 munmap(fb
, fb_len());
126 fbval_t
fb_color(unsigned char r
, unsigned char g
, unsigned char b
)
128 return ((r
>> rr
) << rl
) | ((g
>> gr
) << gl
) | ((b
>> br
) << bl
);
141 static unsigned char *rowaddr(int r
)
143 return fb
+ (r
+ vinfo
.yoffset
) * finfo
.line_length
;
146 static unsigned long cache
[MAXFBWIDTH
];
147 void fb_box(int sr
, int sc
, int er
, int ec
, fbval_t val
)
150 int pc
= sizeof(cache
[0]) / sizeof(val
);
151 int cn
= MIN((ec
- sc
) / pc
+ 1, MAXFBWIDTH
);
152 unsigned long nv
= val
;
153 for (i
= 1; i
< pc
; i
++)
154 nv
= (nv
<< (sizeof(val
) * 8)) | val
;
155 for (i
= 0; i
< cn
; i
++)
157 for (i
= sr
; i
< er
; i
++)
158 memcpy(rowaddr(i
) + sc
* BPP
, cache
, (ec
- sc
) * BPP
);