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 < screen_rect.x) {
  99                 drect.x = screen_rect.x;
 100         }
 101
 102         if(drect.y < screen_rect.y) {
 103                 drect.y = screen_rect.y;
 104         }
 105
 106         if(drect.x + drect.width > screen_rect.width) {
 107                 drect.width = screen_rect.width - drect.x;
 108         }
 109
 110         if(drect.y + drect.height > screen_rect.height) {
 111                 drect.height = screen_rect.height - drect.y;
 112         }
 113
 114         unsigned char *fb = framebuffer + (drect.x + screen_rect.width * drect.y) * 4;
 115         for(int i=0; i<drect.height; i++) {
 116                 for(int j=0; j<drect.width; j++) {
 117                         fb[j * 4] = b;
 118                         fb[j * 4 + 1] = g;
 119                         fb[j * 4 + 2] = r;
 120                 }
 121                 fb += screen_rect.width * 4;
 122         }
 123 }
 124
 125 void set_cursor_visibility(bool visible)
 126 {
 127         fb_cursor curs;
 128         curs.enable = visible ? 1 : 0;
 129
 130         if(ioctl(dev_fd, FBIO_CURSOR, &curs) == -1) {
 131                 fprintf(stderr, "Cannot toggle cursor visibility : %s\n", strerror(errno));
 132         }
 133 }
 134
 135 void blit(unsigned char *src_img, const Rect &src_rect, unsigned char* dest_img,
 136                 const Rect &dest_rect, int dest_x, int dest_y)
 137 {
 138         int width = src_rect.width;
 139         int height = src_rect.height;
 140
 141         int xoffs = dest_x - dest_rect.x;
 142         if(xoffs < 0) {
 143                 dest_x = dest_rect.x;
 144                 width += xoffs;
 145         }
 146
 147         int yoffs = dest_y - dest_rect.y;
 148         if(yoffs < 0) {
 149                 dest_y = dest_rect.y;
 150                 height += yoffs;
 151         }
 152
 153         int xend = dest_x + width;
 154         if(xend >= dest_rect.width) {
 155                 width -= xend - dest_rect.width;
 156         }
 157
 158         int yend = dest_y + height;
 159         if(yend >= dest_rect.height) {
 160                 height -= yend - dest_rect.height;
 161         }
 162
 163         if(width <= 0 || height <= 0) {
 164                 return;
 165         }
 166
 167         unsigned char *sptr = src_img + (src_rect.y * src_rect.width + src_rect.x) * 4;
 168         unsigned char *dptr = dest_img + (dest_y * dest_rect.width + dest_x) * 4;
 169
 170         for(int i=0; i<height; i++) {
 171                 memcpy(dptr, sptr, width * 4);
 172                 sptr += src_rect.width * 4;
 173                 dptr += dest_rect.width * 4;
 174         }
 175 }
 176
 177 void blit_key(unsigned char *src_img, const Rect &src_rect, unsigned char* dest_img,
 178                 const Rect &dest_rect, int dest_x, int dest_y, int key_r, int key_g, int key_b)
 179 {
 180         int width = src_rect.width;
 181         int height = src_rect.height;
 182
 183         int xoffs = dest_x - dest_rect.x;
 184         if(xoffs < 0) {
 185                 dest_x = dest_rect.x;
 186                 width += xoffs;
 187         }
 188
 189         int yoffs = dest_y - dest_rect.y;
 190         if(yoffs < 0) {
 191                 dest_y = dest_rect.y;
 192                 height += yoffs;
 193         }
 194
 195         int xend = dest_x + width;
 196         if(xend >= dest_rect.width) {
 197                 width -= xend - dest_rect.width;
 198         }
 199
 200         int yend = dest_y + height;
 201         if(yend >= dest_rect.height) {
 202                 height -= yend - dest_rect.height;
 203         }
 204
 205         if(width <= 0 || height <= 0) {
 206                 return;
 207         }
 208
 209         unsigned char *sptr = src_img + (src_rect.y * src_rect.width + src_rect.x) * 4;
 210         unsigned char *dptr = dest_img + (dest_y * dest_rect.width + dest_x) * 4;
 211
 212         for(int i=0; i<height; i++) {
 213                 for(int j=0; j<width; j++) {
 214                         int r = sptr[j * 4];
 215                         int g = sptr[j * 4 + 1];
 216                         int b = sptr[j * 4 + 2];
 217
 218                         if(r != key_r || g != key_g || b != key_b) {
 219                                 dptr[j * 4] = b;
 220                                 dptr[j * 4 + 1] = g;
 221                                 dptr[j * 4 + 2] = r;
 222                         }
 223                 }
 224
 225                 sptr += src_rect.width * 4;
 226                 dptr += dest_rect.width * 4;
 227         }
 228 }
 229
 230 void gfx_update()
 231 {
 232 }
 233
 234 #endif // WINNIE_FBDEV