diff options
Diffstat (limited to 'glcddrivers/framebuffer.c')
| -rw-r--r-- | glcddrivers/framebuffer.c | 249 |
1 files changed, 249 insertions, 0 deletions
diff --git a/glcddrivers/framebuffer.c b/glcddrivers/framebuffer.c new file mode 100644 index 0000000..f9666fa --- /dev/null +++ b/glcddrivers/framebuffer.c @@ -0,0 +1,249 @@ +/* + * GraphLCD driver library + * + * framebuffer.h - framebuffer device + * Output goes to a framebuffer device + * + * This file is released under the GNU General Public License. Refer + * to the COPYING file distributed with this package. + * + * (c) 2004 Stephan Skrodzki + */ + +#include <fcntl.h> +#include <stdio.h> +#include <syslog.h> +#include <unistd.h> +#include <sys/mman.h> +#include <sys/ioctl.h> + +#include "common.h" +#include "config.h" +#include "framebuffer.h" + + +namespace GLCD +{ + +cDriverFramebuffer::cDriverFramebuffer(cDriverConfig * config) +: config(config), + offbuff(0), + fbfd(-1) +{ + oldConfig = new cDriverConfig(*config); +} + +cDriverFramebuffer::~cDriverFramebuffer() +{ + delete oldConfig; +} + +int cDriverFramebuffer::Init() +{ + // default values + width = config->width; + if (width <= 0) + width = 320; + height = config->height; + if (height <= 0) + height = 240; + zoom = 1; + + for (unsigned int i = 0; i < config->options.size(); i++) + { + if (config->options[i].name == "Zoom") + { + int z = atoi(config->options[i].value.c_str()); + if (z == 0 || z == 1) + zoom = z; + else + syslog(LOG_ERR, "%s error: zoom %d not supported, using default (%d)!\n", + config->name.c_str(), z, zoom); + } + } + + // Open the file for reading and writing + fbfd = open("/dev/fb0", O_RDWR); + if (1 == fbfd) + { + syslog(LOG_ERR, "%s: cannot open framebuffer device.\n", config->name.c_str()); + return -1; + } + syslog(LOG_INFO, "%s: The framebuffer device was opened successfully.\n", config->name.c_str()); + + // Get fixed screen information + if (ioctl(fbfd, FBIOGET_FSCREENINFO, &finfo)) + { + syslog(LOG_ERR, "%s: Error reading fixed information.\n", config->name.c_str()); + return -1; + } + + // Get variable screen information + if (ioctl(fbfd, FBIOGET_VSCREENINFO, &vinfo)) + { + syslog(LOG_ERR, "%s: Error reading variable information.\n", config->name.c_str()); + return -1; + } + + // Figure out the size of the screen in bytes + screensize = vinfo.xres * vinfo.yres * vinfo.bits_per_pixel / 8; + + syslog(LOG_INFO, "%s: V01: xres: %d, yres %d, vyres: %d, bpp: %d, linelenght: %d\n", config->name.c_str(),vinfo.xres,vinfo.yres,vinfo.yres_virtual,vinfo.bits_per_pixel,finfo.line_length); + + // reserve another memory to draw into + offbuff = new char[screensize]; + if (!offbuff) + { + syslog(LOG_ERR, "%s: failed to alloc memory for framebuffer device.\n", config->name.c_str()); + return -1; + } + + // Map the device to memory + fbp = mmap(0, screensize, PROT_READ | PROT_WRITE, MAP_SHARED, fbfd, 0); + if (fbp == MAP_FAILED) + { + syslog(LOG_ERR, "%s: failed to map framebuffer device to memory.\n", config->name.c_str()); + return -1; + } + syslog(LOG_INFO, "%s: The framebuffer device was mapped to memory successfully.\n", config->name.c_str()); + + *oldConfig = *config; + + // clear display + Refresh(true); + + syslog(LOG_INFO, "%s: Framebuffer initialized.\n", config->name.c_str()); + return 0; +} + +int cDriverFramebuffer::DeInit() +{ + if (offbuff) + delete[] offbuff; + munmap(fbp, screensize); + if (-1 != fbfd) + close(fbfd); + return 0; +} + +int cDriverFramebuffer::CheckSetup() +{ + if (config->device != oldConfig->device || + config->port != oldConfig->port || + config->width != oldConfig->width || + config->height != oldConfig->height) + { + DeInit(); + Init(); + return 0; + } + + if (config->upsideDown != oldConfig->upsideDown || + config->invert != oldConfig->invert) + { + oldConfig->upsideDown = config->upsideDown; + oldConfig->invert = config->invert; + return 1; + } + return 0; +} + +void cDriverFramebuffer::SetPixel(int x, int y) +{ + int location; + int outcol; + + if (x >= width || y >= height) + return; + + if (config->upsideDown) + { + x = width - 1 - x; + y = height - 1 - y; + } + + // Figure out where in memory to put the pixel + location = (x*(1+zoom)+vinfo.xoffset) * (vinfo.bits_per_pixel/8) + + (y*(1+zoom)+vinfo.yoffset) * finfo.line_length; + + if (vinfo.bits_per_pixel <= 8) + { + outcol = 15; + } + else + { + outcol = 255; + } + + if (vinfo.bits_per_pixel <= 8) + { + *(offbuff + location) = outcol; + if (zoom == 1) + { + *(offbuff + location + 1) = outcol; + *(offbuff + location + finfo.line_length) = outcol; + *(offbuff + location + finfo.line_length + 1) = outcol; + } + } + else if (vinfo.bits_per_pixel <= 16) + { + *(offbuff + location) = outcol; + *(offbuff + location + 1) = outcol; + if (zoom == 1) + { + *(offbuff + location + 2) = outcol; + *(offbuff + location + 3) = outcol; + *(offbuff + location + finfo.line_length) = outcol; + *(offbuff + location + finfo.line_length + 1) = outcol; + *(offbuff + location + finfo.line_length + 2) = outcol; + *(offbuff + location + finfo.line_length + 3) = outcol; + } + } + else + { + *(offbuff + location) = outcol; + *(offbuff + location + 1) = outcol; + *(offbuff + location + 2) = outcol; + *(offbuff + location + 3) = 0; /* should be transparency */ + if (zoom == 1) + { + *(offbuff + location + 4) = outcol; + *(offbuff + location + 5) = outcol; + *(offbuff + location + 6) = outcol; + *(offbuff + location + 7) = 0; + *(offbuff + location + finfo.line_length) = outcol; + *(offbuff + location + finfo.line_length + 1) = outcol; + *(offbuff + location + finfo.line_length + 2) = outcol; + *(offbuff + location + finfo.line_length + 3) = 0; + *(offbuff + location + finfo.line_length + 4) = outcol; + *(offbuff + location + finfo.line_length + 5) = outcol; + *(offbuff + location + finfo.line_length + 6) = outcol; + *(offbuff + location + finfo.line_length + 7) = 0; + } + } +} + +void cDriverFramebuffer::Clear() +{ + memset(offbuff, 0, screensize); +} + +void cDriverFramebuffer::Set8Pixels(int x, int y, unsigned char data) +{ + int n; + + x &= 0xFFF8; + + for (n = 0; n < 8; ++n) + { + if (data & (0x80 >> n)) // if bit is set + SetPixel(x + n, y); + } +} + +void cDriverFramebuffer::Refresh(bool refreshAll) +{ + memcpy(fbp, offbuff, screensize); +} + +} // end of namespace |