lib/gdi/fb.cpp

   1 #include <stdio.h>
   2 #include <stdlib.h>
   3 #include <fcntl.h>
   4 #include <sys/ioctl.h>
   5 #include <unistd.h>
   6 #include <sys/mman.h>
   7 #include <memory.h>
   8 #include <linux/kd.h>
   9
  10 #include <lib/gdi/fb.h>
  11
  12 #ifndef FBIO_WAITFORVSYNC
  13 #define FBIO_WAITFORVSYNC _IOW('F', 0x20, __u32)
  14 #endif
  15
  16
  17 fbClass *fbClass::instance;
  18
  19 fbClass *fbClass::getInstance()
  20 {
  21         return instance;
  22 }
  23
  24 fbClass::fbClass(const char *fb)
  25 {
  26         instance=this;
  27         locked=0;
  28         available=0;
  29         cmap.start=0;
  30         cmap.len=256;
  31         cmap.red=red;
  32         cmap.green=green;
  33         cmap.blue=blue;
  34         cmap.transp=trans;
  35
  36         fd=open(fb, O_RDWR);
  37         if (fd<0)
  38         {
  39                 perror(fb);
  40                 goto nolfb;
  41         }
  42         if (ioctl(fd, FBIOGET_VSCREENINFO, &screeninfo)<0)
  43         {
  44                 perror("FBIOGET_VSCREENINFO");
  45                 goto nolfb;
  46         }
  47
  48         memcpy(&oldscreen, &screeninfo, sizeof(screeninfo));
  49
  50         fb_fix_screeninfo fix;
  51         if (ioctl(fd, FBIOGET_FSCREENINFO, &fix)<0)
  52         {
  53                 perror("FBIOGET_FSCREENINFO");
  54                 goto nolfb;
  55         }
  56
  57         available=fix.smem_len;
  58         eDebug("%dk video mem", available/1024);
  59         lfb=(unsigned char*)mmap(0, available, PROT_WRITE|PROT_READ, MAP_SHARED, fd, 0);
  60         if (!lfb)
  61         {
  62                 perror("mmap");
  63                 goto nolfb;
  64         }
  65
  66         showConsole(0);
  67         return;
  68 nolfb:
  69         lfb=0;
  70         printf("framebuffer not available.\n");
  71         return;
  72 }
  73
  74 int fbClass::showConsole(int state)
  75 {
  76         int fd=open("/dev/vc/0", O_RDWR);
  77         if(fd>=0)
  78         {
  79                 if(ioctl(fd, KDSETMODE, state?KD_TEXT:KD_GRAPHICS)<0)
  80                 {
  81                         eDebug("setting /dev/vc/0 status failed.");
  82                 }
  83                 close(fd);
  84         }
  85         return 0;
  86 }
  87
  88 int fbClass::SetMode(unsigned int nxRes, unsigned int nyRes, unsigned int nbpp)
  89 {
  90         screeninfo.xres_virtual=screeninfo.xres=nxRes;
  91         screeninfo.yres_virtual=(screeninfo.yres=nyRes)*2;
  92         screeninfo.height=0;
  93         screeninfo.width=0;
  94         screeninfo.xoffset=screeninfo.yoffset=0;
  95         screeninfo.bits_per_pixel=nbpp;
  96
  97         if (ioctl(fd, FBIOPUT_VSCREENINFO, &screeninfo)<0)
  98         {
  99                 // try single buffering
 100                 screeninfo.yres_virtual=screeninfo.yres=nyRes;
 101
 102                 if (ioctl(fd, FBIOPUT_VSCREENINFO, &screeninfo)<0)
 103                 {
 104                         perror("FBIOPUT_VSCREENINFO");
 105                         printf("fb failed\n");
 106                         return -1;
 107                 }
 108                 eDebug(" - double buffering not available.");
 109         } else
 110                 eDebug(" - double buffering available!");
 111
 112         m_number_of_pages = screeninfo.yres_virtual / nyRes;
 113
 114         if ((screeninfo.xres!=nxRes) && (screeninfo.yres!=nyRes) && (screeninfo.bits_per_pixel!=nbpp))
 115         {
 116                 eDebug("SetMode failed: wanted: %dx%dx%d, got %dx%dx%d",
 117                         nxRes, nyRes, nbpp,
 118                         screeninfo.xres, screeninfo.yres, screeninfo.bits_per_pixel);
 119         }
 120         xRes=screeninfo.xres;
 121         yRes=screeninfo.yres;
 122         bpp=screeninfo.bits_per_pixel;
 123         fb_fix_screeninfo fix;
 124         if (ioctl(fd, FBIOGET_FSCREENINFO, &fix)<0)
 125         {
 126                 perror("FBIOGET_FSCREENINFO");
 127                 printf("fb failed\n");
 128         }
 129         stride=fix.line_length;
 130         memset(lfb, 0, stride*yRes);
 131         return 0;
 132 }
 133
 134 int fbClass::setOffset(int off)
 135 {
 136         screeninfo.xoffset = 0;
 137         screeninfo.yoffset = off;
 138         return ioctl(fd, FBIOPAN_DISPLAY, &screeninfo);
 139 }
 140
 141 int fbClass::waitVSync()
 142 {
 143         int c = 0;
 144         return ioctl(fd, FBIO_WAITFORVSYNC, &c);
 145 }
 146
 147 fbClass::~fbClass()
 148 {
 149         if (available)
 150                 ioctl(fd, FBIOPUT_VSCREENINFO, &oldscreen);
 151         if (lfb)
 152                 munmap(lfb, available);
 153         showConsole(1);
 154 }
 155
 156 int fbClass::PutCMAP()
 157 {
 158         return ioctl(fd, FBIOPUTCMAP, &cmap);
 159 }
 160
 161 int fbClass::lock()
 162 {
 163         if (locked)
 164                 return -1;
 165         locked=1;
 166         return fd;
 167 }
 168
 169 void fbClass::unlock()
 170 {
 171         if (!locked)
 172                 return;
 173         locked=0;
 174         SetMode(xRes, yRes, bpp);
 175         PutCMAP();
 176 }