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
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
|
#include <errno.h>
#include <fcntl.h>
#include <linux/fb.h>
#include <linux/kd.h>
#include <stdarg.h>
#include <string.h>
#include <stdint.h>
#include <stdio.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <sys/uio.h>
#include <time.h>
#include <unistd.h>
static const char* tmp_fmt(const char* fmt, ...)
{
static char msg[1024] = { 0 };
va_list va; va_start(va, fmt);
vsnprintf(msg, sizeof(msg), fmt, va);
va_end(va);
return msg;
}
static void spew(const char* message)
{
// Kernel log is available after init
int kmfd = open("/dev/kmsg", O_WRONLY | O_CLOEXEC);
struct iovec msgvec[] = {
#define STRVEC(str) { .iov_base = (void*)(str), .iov_len = __builtin_strlen(str) }
STRVEC("rlwsd: "),
STRVEC(message),
STRVEC("\n")
#undef STRVEC
};
writev(kmfd, msgvec, sizeof(msgvec) / sizeof(*msgvec));
close(kmfd);
}
static void panic(const char* message)
{
spew(message);
_exit(1); // Triggers a kernel panic since we're PID 1
}
static inline uint32_t pack_rgb(const struct fb_var_screeninfo* v, uint8_t r, uint8_t g, uint8_t b)
{
uint32_t rv = (v->red.length ? ((uint32_t)r * ((1u << v->red.length) - 1) + 127) / 255 : 0);
uint32_t gv = (v->green.length ? ((uint32_t)g * ((1u << v->green.length) - 1) + 127) / 255 : 0);
uint32_t bv = (v->blue.length ? ((uint32_t)b * ((1u << v->blue.length) - 1) + 127) / 255 : 0);
return (rv << v->red.offset) | (gv << v->green.offset) | (bv << v->blue.offset);
}
static inline void write_pixel(uint8_t* p, uint32_t bpp, uint32_t pix)
{
uint32_t bytes = bpp / 8;
for (uint32_t i = 0; i < bytes; i++)
p[i] = (uint8_t)(pix >> (8u * i)); // little-endian write
}
int main(void)
{
int fd = open("/dev/fb0", O_RDWR | O_CLOEXEC);
if (fd < 0) {
panic(tmp_fmt("Failed to open /dev/fb0: %s", strerror(errno)));
}
struct fb_fix_screeninfo finfo;
struct fb_var_screeninfo vinfo;
if (ioctl(fd, FBIOGET_FSCREENINFO, &finfo) != 0) {
panic(tmp_fmt("FBIOGET_FSCREENINFO: %s", strerror(errno)));
}
if (ioctl(fd, FBIOGET_VSCREENINFO, &vinfo) != 0) {
panic(tmp_fmt("FBIOGET_VSCREENINFO: %s", strerror(errno)));
}
spew(tmp_fmt("fb0: %ux%u bpp=%u line_length=%u visual=%u",
vinfo.xres, vinfo.yres, vinfo.bits_per_pixel,
finfo.line_length, finfo.visual));
spew(tmp_fmt("fb0: R %u/%u G %u/%u B %u/%u",
vinfo.red.offset, vinfo.red.length,
vinfo.green.offset, vinfo.green.length,
vinfo.blue.offset, vinfo.blue.length));
if (!(vinfo.bits_per_pixel == 24 || vinfo.bits_per_pixel == 32)) {
panic("Unsupported BPP");
}
// Disable TTY
int tty = open("/dev/tty0", O_RDWR);
if (tty < 0) {
tty = open("/dev/console", O_RDWR);
if (tty < 0) {
panic(tmp_fmt("Couldn't open tty: %s", strerror(errno)));
}
}
if (ioctl(tty, KDSETMODE, KD_GRAPHICS) != 0) {
panic(tmp_fmt("Failed to set tty mode to KD_GRAPHICS: %s", strerror(errno)));
}
close(tty);
size_t fb_size = (size_t)finfo.line_length * vinfo.yres;
uint8_t* fb = (uint8_t*)mmap(NULL, fb_size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
if (fb == MAP_FAILED) {
panic(tmp_fmt("mmap failed: %s", strerror(errno)));
}
#if 1
for (uint32_t y = 0; y < vinfo.yres; ++y) {
uint8_t* row = fb + (size_t)y * finfo.line_length;
memset(row, 0x00, finfo.line_length);
}
#endif
uint8_t lum = 0;
uint32_t y = 0;
float then = 0.0f;
for (;;)
{
struct timespec ts;
clock_gettime(CLOCK_MONOTONIC, &ts);
float now = ts.tv_sec + (ts.tv_nsec / 1e9f);
if ((now - then) >= (1.0f / 60.0f)) {
then = now;
uint32_t pix = pack_rgb(&vinfo, lum, lum, lum);
uint8_t* row = fb + (size_t)y * finfo.line_length;
for (size_t x = 0; x < vinfo.xres; ++x) {
size_t bpp = vinfo.bits_per_pixel;
size_t bypp = bpp / 8;
write_pixel(&row[(size_t)x * bypp], bpp, pix);
}
lum = (lum + 7) % 255;
y = (y + 1) % (vinfo.yres - 1);
}
}
}
|
