eleni.mutantstargoat.com Git - winnie/blob - src/fbdev/gfx.cc

   1 #ifdef WINNIE_FBDEV
   2 #include <errno.h>
   3 #include <limits.h>
   4 #include <stdio.h>
   5 #include <string.h>
   6
   7 #include <fcntl.h>
   8 #include <sys/ioctl.h>
   9 #include <sys/mman.h>
  10 #include <unistd.h>
  11
  12 #include <linux/fb.h>
  13
  14 #include "gfx.h"
  15
  16 #define FRAMEBUFFER_SIZE(xsz, ysz, bpp) ((xsz) * (ysz) * (bpp) / CHAR_BIT)
  17
  18 static unsigned char *framebuffer;
  19 static int dev_fd = -1;
  20
  21 static Rect screen_rect;
  22 static int color_depth; // bits per pixel
  23
  24 bool init_gfx()
  25 {
  26         if((dev_fd = open("/dev/fb0", O_RDWR)) == -1) {
  27                 fprintf(stderr, "Cannot open /dev/fb0 : %s\n", strerror(errno));
  28                 return false;
  29         }
  30
  31         fb_var_screeninfo sinfo;
  32         if(ioctl(dev_fd, FBIOGET_VSCREENINFO, &sinfo) == -1) {
  33                 close(dev_fd);
  34                 dev_fd = -1;
  35                 fprintf(stderr, "Unable to get screen info : %s\n", strerror(errno));
  36                 return false;
  37         }
  38
  39         printf("width : %d height : %d\n : bpp : %d\n", sinfo.xres, sinfo.yres, sinfo.bits_per_pixel);
  40         printf("virtual w: %d virtual h: %d\n", sinfo.xres_virtual, sinfo.yres_virtual);
  41
  42         screen_rect.x = screen_rect.y = 0;
  43         screen_rect.width = sinfo.xres_virtual;
  44         screen_rect.height = sinfo.yres_virtual;
  45         color_depth = sinfo.bits_per_pixel;
  46
  47         int sz = FRAMEBUFFER_SIZE(screen_rect.width, screen_rect.height, color_depth);
  48         framebuffer = (unsigned char*)mmap(0, sz, PROT_READ | PROT_WRITE, MAP_SHARED, dev_fd, 0);
  49
  50         if(framebuffer == (void*)-1) {
  51                 close(dev_fd);
  52                 dev_fd = -1;
  53                 fprintf(stderr, "Cannot map the framebuffer to memory : %s\n", strerror(errno));
  54                 return false;
  55         }
  56
  57         return true;
  58 }
  59
  60 void destroy_gfx()
  61 {
  62         clear_screen(0, 0, 0);
  63
  64         if(dev_fd != -1) {
  65                 close(dev_fd);
  66         }
  67
  68         dev_fd = -1;
  69
  70         munmap(framebuffer, FRAMEBUFFER_SIZE(screen_rect.width, screen_rect.height, color_depth));
  71         framebuffer = 0;
  72 }
  73
  74 unsigned char *get_framebuffer()
  75 {
  76         return framebuffer;
  77 }
  78
  79 Rect get_screen_size()
  80 {
  81         return screen_rect;
  82 }
  83
  84 int get_color_depth()
  85 {
  86         return color_depth;
  87 }
  88
  89 void clear_screen(int r, int g, int b)
  90 {
  91         fill_rect(screen_rect, r, g, b);
  92 }
  93
  94 void fill_rect(const Rect &rect, int r, int g, int b)
  95 {
  96         Rect drect = rect;
  97
  98         if(drect.x < 0) {
  99                 drect.x = 0;
 100         }
 101
 102         if(drect.y < 0) {
 103                 drect.y = 0;
 104         }
 105
 106         unsigned char *fb = framebuffer + (drect.x + screen_rect.width * drect.y) * 4;
 107         for(int i=0; i<drect.height; i++) {
 108                 for(int j=0; j<drect.width; j++) {
 109                         fb[j * 4] = b;
 110                         fb[j * 4 + 1] = g;
 111                         fb[j * 4 + 2] = r;
 112                 }
 113                 fb += screen_rect.width * 4;
 114         }
 115 }
 116
 117 void set_cursor_visibility(bool visible)
 118 {
 119         fb_cursor curs;
 120         curs.enable = visible ? 1 : 0;
 121
 122         if(ioctl(dev_fd, FBIO_CURSOR, &curs) == -1) {
 123                 fprintf(stderr, "Cannot toggle cursor visibility : %s\n", strerror(errno));
 124         }
 125 }
 126
 127 void blit(unsigned char *src_img, const Rect &src_rect, unsigned char* dest_img,
 128                 const Rect &dest_rect, int dest_x, int dest_y)
 129 {
 130         int width = src_rect.width;
 131         int height = src_rect.height;
 132
 133         int xoffs = dest_x - dest_rect.x;
 134         if(xoffs < 0) {
 135                 dest_x = dest_rect.x;
 136                 width += xoffs;
 137         }
 138
 139         int yoffs = dest_y - dest_rect.y;
 140         if(yoffs < 0) {
 141                 dest_y = dest_rect.y;
 142                 height += yoffs;
 143         }
 144
 145         int xend = dest_x + width;
 146         if(xend >= dest_rect.width) {
 147                 width -= xend - dest_rect.width;
 148         }
 149
 150         int yend = dest_y + height;
 151         if(yend >= dest_rect.height) {
 152                 height -= yend - dest_rect.height;
 153         }
 154
 155         if(width <= 0 || height <= 0) {
 156                 return;
 157         }
 158
 159         unsigned char *sptr = src_img + (src_rect.y * src_rect.width + src_rect.x) * 4;
 160         unsigned char *dptr = dest_img + (dest_y * dest_rect.width + dest_x) * 4;
 161
 162         for(int i=0; i<height; i++) {
 163                 memcpy(dptr, sptr, width * 4);
 164                 sptr += src_rect.width * 4;
 165                 dptr += dest_rect.width * 4;
 166         }
 167 }
 168
 169 void blit_key(unsigned char *src_img, const Rect &src_rect, unsigned char* dest_img,
 170                 const Rect &dest_rect, int dest_x, int dest_y, int key_r, int key_g, int key_b)
 171 {
 172         int width = src_rect.width;
 173         int height = src_rect.height;
 174
 175         int xoffs = dest_x - dest_rect.x;
 176         if(xoffs < 0) {
 177                 dest_x = dest_rect.x;
 178                 width += xoffs;
 179         }
 180
 181         int yoffs = dest_y - dest_rect.y;
 182         if(yoffs < 0) {
 183                 dest_y = dest_rect.y;
 184                 height += yoffs;
 185         }
 186
 187         int xend = dest_x + width;
 188         if(xend >= dest_rect.width) {
 189                 width -= xend - dest_rect.width;
 190         }
 191
 192         int yend = dest_y + height;
 193         if(yend >= dest_rect.height) {
 194                 height -= yend - dest_rect.height;
 195         }
 196
 197         if(width <= 0 || height <= 0) {
 198                 return;
 199         }
 200
 201         unsigned char *sptr = src_img + (src_rect.y * src_rect.width + src_rect.x) * 4;
 202         unsigned char *dptr = dest_img + (dest_y * dest_rect.width + dest_x) * 4;
 203
 204         for(int i=0; i<height; i++) {
 205                 for(int j=0; j<width; j++) {
 206                         int r = sptr[j * 4];
 207                         int g = sptr[j * 4 + 1];
 208                         int b = sptr[j * 4 + 2];
 209
 210                         if(r != key_r || g != key_g || b != key_b) {
 211                                 dptr[j * 4] = b;
 212                                 dptr[j * 4 + 1] = g;
 213                                 dptr[j * 4 + 2] = r;
 214                         }
 215                 }
 216
 217                 sptr += src_rect.width * 4;
 218                 dptr += dest_rect.width * 4;
 219         }
 220 }
 221
 222 void gfx_update()
 223 {
 224 }
 225
 226 #endif // WINNIE_FBDEV