Modified for use for eth0

This commit is contained in:
Hylke44 2017-02-18 01:24:00 +01:00
parent bea3ec8fec
commit e26592df19
4 changed files with 179 additions and 54 deletions

View file

@ -1,3 +1,10 @@
/***************************************************
* The following frame buffer modes are supported:
* - 24bpp - rgba 8/16,8/8,8/0,0/0
* - 32bpp - rgba 8/24,8/16,8/8,0,0
*
* Use "fbset -s" to get the currently used mode
**************************************************/
#include "screenbuffer.h"
#include <unistd.h>
@ -16,8 +23,7 @@ long int screensize = 0;
char *fbp = 0;
int8_t init_frame_buffer(void)
{
int8_t init_frame_buffer(void) {
// Open the file for reading and writing
fbfd = open("/dev/fb0", O_RDWR);
if (!fbfd) {
@ -31,16 +37,27 @@ int8_t init_frame_buffer(void)
printf("Error reading variable information.\n");
return 0;
}
printf("Screen info %dx%d, %dbpp\n", vinfo.xres, vinfo.yres,
vinfo.bits_per_pixel );
printf("Screen info %dx%d, %dbpp\n", vinfo.xres, vinfo.yres, vinfo.bits_per_pixel );
// Get fixed screen information
if (ioctl(fbfd, FBIOGET_FSCREENINFO, &finfo)) {
printf("Error reading fixed information.\n");
return 0;
}
// Check if the framebuffer mode is supported
if ((vinfo.bits_per_pixel == 24 || vinfo.bits_per_pixel == 32) &&
vinfo.red.length == 8 && vinfo.red.offset == 16 &&
vinfo.green.length == 8 && vinfo.green.offset == 8 &&
vinfo.blue.length == 8 && vinfo.blue.offset == 0 &&
vinfo.transp.length == 0 && vinfo.transp.offset == 0) {
printf("Screen buffer mode is supported.\n");
} else {
printf("ERROR: Screen buffer mode is not supported.\n");
return 0;
}
// map fb to user mem
// Map fb to user mem
screensize = finfo.smem_len;
fbp = (char*)mmap(0,
screensize,
@ -66,22 +83,63 @@ void deinit_frame_buffer(void)
void write_pixel_to_screen(uint16_t x, uint16_t y, uint8_t r, uint8_t g, uint8_t b, uint8_t a){
uint32_t pix_offset;
uint8_t bpp = vinfo.bits_per_pixel / 8;
union {
uint32_t pixel32;
uint8_t pixel8[4];
} pixel;
uint8_t i;
uint16_t temp_r, temp_g, temp_b;
if(x < vinfo.xres && y < vinfo.yres){
pixel.pixel32 = 0;
pixel.pixel32 |= ((uint32_t)r >> (8 - vinfo.red.length)) << vinfo.red.offset;
pixel.pixel32 |= ((uint32_t)g >> (8 - vinfo.green.length)) << vinfo.green.offset;
pixel.pixel32 |= ((uint32_t)b >> (8 - vinfo.blue.length)) << vinfo.blue.offset;
pix_offset = bpp * x + y * finfo.line_length;
for (i=0; i<bpp; i++) {
fbp[pix_offset+i] = pixel.pixel8[i];
// If the pixel is out of the screen there is not need to draw it
if (x >= vinfo.xres || y >= vinfo.yres) {
return;
}
//pix_offset = byte_pp * x + y * finfo.line_length;
// If alpha is used calculate it, otherwise just paint the colors
if (a != 0xFF) {
// Get the old pixel
if (vinfo.bits_per_pixel == 24) {
// 24bpp format
pix_offset = 3 * x + y * finfo.line_length;
temp_r = fbp[pix_offset+0];
temp_g = fbp[pix_offset+1];
temp_b = fbp[pix_offset+2];
} else if (vinfo.bits_per_pixel == 32) {
// 32bpp format
pix_offset = 4 * x + y * finfo.line_length;
temp_r = fbp[pix_offset+0];
temp_g = fbp[pix_offset+1];
temp_b = fbp[pix_offset+2];
} else {
temp_r = 0;
temp_g = 0;
temp_b = 0;
}
//printf("%08x : %04x %04x %04x\n", pixel.pixel32, temp_r, temp_g, temp_b);
// Aply alpha
temp_r = (temp_r * (256-a))>>8;
temp_r = temp_r + ((r * (a))>>8);
temp_g = (temp_g * (256-a))>>8;
temp_g = temp_g + ((g * (a))>>8);
temp_b = (temp_b * (256-a))>>8;
temp_b = temp_b + ((b * (a))>>8);
} else {
temp_r = r;
temp_g = g;
temp_b = b;
}
// Write new pixels to buffer
if (vinfo.bits_per_pixel == 24) {
// 24bpp format
pix_offset = 3 * x + y * finfo.line_length;
fbp[pix_offset+2] = temp_r;
fbp[pix_offset+1] = temp_g;
fbp[pix_offset+0] = temp_b;
}
if (vinfo.bits_per_pixel == 32) {
// 32bpp format
pix_offset = 4 * x + y * finfo.line_length;
fbp[pix_offset+2] = temp_r;
fbp[pix_offset+1] = temp_g;
fbp[pix_offset+0] = temp_b;
}
}