| 1 | /****************************************************************************** |
| 2 | * fbtest - fbtest.c |
| 3 | * test program for the tuxbox-framebuffer device |
| 4 | * tests all GTX/eNX supported modes |
| 5 | * |
| 6 | * (c) 2003 Carsten Juttner (carjay@gmx.net) |
| 7 | * |
| 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * The Free Software Foundation; either version 2 of the License, or |
| 11 | * (at your option) any later version. |
| 12 | * |
| 13 | * This program is distributed in the hope that it will be useful, |
| 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 16 | * GNU General Public License for more details. |
| 17 | * |
| 18 | * You should have received a copy of the GNU General Public License |
| 19 | * along with this program; if not, write to the Free Software |
| 20 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| 21 | * |
| 22 | ****************************************************************************** |
| 23 | * $Id: fbtest.c,v 1.5 2005/01/14 23:14:41 carjay Exp $ |
| 24 | ******************************************************************************/ |
| 25 | |
| 26 | // TODO: - should restore the colour map and mode to what it was before |
| 27 | // - is colour map handled correctly? |
| 28 | |
| 29 | #include <stdio.h> |
| 30 | #include <stdlib.h> |
| 31 | #include <unistd.h> |
| 32 | #include <string.h> |
| 33 | |
| 34 | #include <sys/types.h> |
| 35 | #include <sys/stat.h> |
| 36 | #include <sys/ioctl.h> |
| 37 | #include <sys/mman.h> |
| 38 | #include <fcntl.h> |
| 39 | |
| 40 | #include <linux/fb.h> |
| 41 | |
| 42 | #include <error.h> |
| 43 | |
| 44 | #define FBDEV "/dev/fb0" |
| 45 | |
| 46 | struct vidsize{ |
| 47 | int width; |
| 48 | int height; |
| 49 | }; |
| 50 | static |
| 51 | const struct vidsize vidsizetable[]={ // all supported sizes |
| 52 | {720,576},{720,480},{720,288},{720,240}, |
| 53 | {640,576},{640,480},{640,288},{640,240}, |
| 54 | {360,576},{360,480},{360,288},{360,240}, |
| 55 | {320,576},{320,480},{320,288},{320,240} |
| 56 | }; |
| 57 | #define VIDSIZENUM (sizeof(vidsizetable)/sizeof(struct vidsize)) |
| 58 | |
| 59 | enum pixenum{ // keep in sync with pixname ! |
| 60 | CLUT4=0, |
| 61 | CLUT8, |
| 62 | RGB565, |
| 63 | ARGB1555, |
| 64 | ARGB |
| 65 | }; |
| 66 | const char *pixname[] = { |
| 67 | "CLUT4", |
| 68 | "CLUT8", |
| 69 | "RGB565", |
| 70 | "ARGB1555", |
| 71 | "ARGB" |
| 72 | }; |
| 73 | |
| 74 | struct pixelformat{ |
| 75 | char *name; |
| 76 | struct fb_bitfield red; |
| 77 | struct fb_bitfield green; |
| 78 | struct fb_bitfield blue; |
| 79 | struct fb_bitfield transp; |
| 80 | char bpp; |
| 81 | char pixenum; |
| 82 | }; |
| 83 | |
| 84 | static // so far these are all modes supported by the eNX (only partially by GTX) |
| 85 | const struct pixelformat pixelformattable[] = { |
| 86 | { .name = "CLUT4 ARGB8888", // CLUT4 (ARGB8888) |
| 87 | .bpp = 4, .pixenum = CLUT4, |
| 88 | .red = { .offset = 0, .length=8, .msb_right =0 }, |
| 89 | .green = { .offset = 0, .length=8, .msb_right =0 }, |
| 90 | .blue = { .offset = 0, .length=8, .msb_right =0 }, |
| 91 | .transp= { .offset = 0, .length=8, .msb_right =0 } |
| 92 | }, |
| 93 | { .name = "CLUT4 ARGB1555", // CLUT4 (ARGB1555) |
| 94 | .bpp = 4, .pixenum = CLUT4, |
| 95 | .red = { .offset = 0, .length=5, .msb_right =0 }, |
| 96 | .green = { .offset = 0, .length=5, .msb_right =0 }, |
| 97 | .blue = { .offset = 0, .length=5, .msb_right =0 }, |
| 98 | .transp= { .offset = 0, .length=1, .msb_right =0 } |
| 99 | }, |
| 100 | { .name = "CLUT8 ARGB8888", // CLUT8 (ARGB8888) |
| 101 | .bpp = 8, .pixenum = CLUT8, |
| 102 | .red = { .offset = 0, .length=8, .msb_right =0 }, |
| 103 | .green = { .offset = 0, .length=8, .msb_right =0 }, |
| 104 | .blue = { .offset = 0, .length=8, .msb_right =0 }, |
| 105 | .transp= { .offset = 0, .length=8, .msb_right =0 } |
| 106 | }, |
| 107 | { .name = "CLUT8 ARGB1555", // CLUT8 (ARGB1555) |
| 108 | .bpp = 8, .pixenum = CLUT8, |
| 109 | .red = { .offset = 0, .length=5, .msb_right =0 }, |
| 110 | .green = { .offset = 0, .length=5, .msb_right =0 }, |
| 111 | .blue = { .offset = 0, .length=5, .msb_right =0 }, |
| 112 | .transp= { .offset = 0, .length=1, .msb_right =0 } |
| 113 | }, |
| 114 | { .name = "ARGB1555", // ARGB1555 |
| 115 | .bpp = 16, .pixenum = ARGB1555, |
| 116 | .red = { .offset = 10, .length=5, .msb_right =0 }, |
| 117 | .green = { .offset = 5, .length=5, .msb_right =0 }, |
| 118 | .blue = { .offset = 0, .length=5, .msb_right =0 }, |
| 119 | .transp= { .offset = 15, .length=1, .msb_right =0 } |
| 120 | }, |
| 121 | { .name = "RGB565", // RGB565 |
| 122 | .bpp = 16, .pixenum = RGB565, |
| 123 | .red = { .offset = 11, .length=5, .msb_right =0 }, |
| 124 | .green = { .offset = 5, .length=6, .msb_right =0 }, |
| 125 | .blue = { .offset = 0, .length=5, .msb_right =0 }, |
| 126 | .transp= { .offset = 0, .length=0, .msb_right =0 } |
| 127 | }, |
| 128 | { .name = "ARGB", // 32 f*cking bits, the real McCoy :) |
| 129 | .bpp = 32, .pixenum = ARGB, |
| 130 | .red = { .offset = 16, .length=8, .msb_right =0 }, |
| 131 | .green = { .offset = 8, .length=8, .msb_right =0 }, |
| 132 | .blue = { .offset = 0, .length=8, .msb_right =0 }, |
| 133 | .transp= { .offset = 24, .length=8, .msb_right =0 } |
| 134 | } |
| 135 | }; |
| 136 | #define PIXELFORMATNUM (sizeof(pixelformattable)/sizeof(struct pixelformat)) |
| 137 | |
| 138 | struct colour { |
| 139 | __u16 r; |
| 140 | __u16 g; |
| 141 | __u16 b; |
| 142 | __u16 a; |
| 143 | }; |
| 144 | static |
| 145 | struct colour colourtable[] = { |
| 146 | {.r =0xffff, .g = 0xffff, .b=0xffff, .a=0xffff}, // fully transparent white |
| 147 | {.r =0xffff, .g = 0x0000, .b=0x0000, .a=0x0000}, // red |
| 148 | {.r =0x0000, .g = 0xffff, .b=0x0000, .a=0x0000}, // green |
| 149 | {.r =0x0000, .g = 0x0000, .b=0xffff, .a=0x0000}, // blue |
| 150 | {.r =0x0000, .g = 0x0000, .b=0x0000, .a=0x0000} // black |
| 151 | }; |
| 152 | #define COLOURNUM (sizeof(colourtable)/sizeof(struct colour)) |
| 153 | |
| 154 | struct rect{ |
| 155 | int x; |
| 156 | int y; |
| 157 | int width; |
| 158 | int height; |
| 159 | const struct colour *col; |
| 160 | }; |
| 161 | struct pixel{ // up to 32 bits of pixel information |
| 162 | char byte[4]; |
| 163 | }; |
| 164 | |
| 165 | void col2pixel (struct pixel *pix, const struct pixelformat *pixf, const struct colour *col){ |
| 166 | switch (pixf->pixenum){ |
| 167 | case RGB565: |
| 168 | pix->byte[0]=(col->r&0xf8)|(col->g&0xfc)>>5; |
| 169 | pix->byte[1]=(col->g&0xfc)<<3|(col->b&0xf8)>>3; |
| 170 | break; |
| 171 | case ARGB1555: |
| 172 | pix->byte[0]=(col->a&0x80)|(col->r&0xf8)>>1|(col->g&0xf8)>>6; |
| 173 | pix->byte[1]=(col->g&0xf8)<<2|(col->b&0xf8)>>3; |
| 174 | break; |
| 175 | case ARGB: |
| 176 | pix->byte[0]=col->a; |
| 177 | pix->byte[1]=col->r; |
| 178 | pix->byte[2]=col->g; |
| 179 | pix->byte[3]=col->b; |
| 180 | break; |
| 181 | default: |
| 182 | printf ("unknown pixelformat\n"); |
| 183 | exit(1); |
| 184 | } |
| 185 | } |
| 186 | |
| 187 | int setmode(int fbd, const struct pixelformat *pixf,const struct vidsize *vids){ |
| 188 | struct fb_var_screeninfo var; |
| 189 | int stat; |
| 190 | stat = ioctl (fbd, FBIOGET_VSCREENINFO,&var); |
| 191 | if (stat<0) return -2; |
| 192 | |
| 193 | var.xres= vids->width; |
| 194 | var.xres_virtual = vids->width; |
| 195 | var.yres= vids->height; |
| 196 | var.yres_virtual = vids->height; |
| 197 | |
| 198 | var.bits_per_pixel = pixf->bpp; |
| 199 | var.red = pixf->red; |
| 200 | var.green = pixf->green; |
| 201 | var.blue = pixf->blue; |
| 202 | var.transp = pixf->transp; |
| 203 | |
| 204 | stat = ioctl (fbd, FBIOPUT_VSCREENINFO,&var); |
| 205 | if (stat<0) return -1; |
| 206 | return 0; |
| 207 | } |
| 208 | |
| 209 | // unefficient implementation, do NOT use it for your next ego shooter, please :) |
| 210 | // for 4-Bit only rectangles with even width are supported |
| 211 | // CLUT-modes use value of red component as index |
| 212 | void drawrect(void *videoram, struct rect *r, const struct pixelformat *pixf, const struct vidsize *vids){ |
| 213 | int x,y,corwidth, bpp = 0, tocopy = 1; |
| 214 | struct pixel pix; |
| 215 | unsigned char *pmem = videoram; |
| 216 | corwidth = r->width; // actually only "corrected" for 4 Bit |
| 217 | |
| 218 | if (pixf->pixenum!=CLUT4&&pixf->pixenum!=CLUT8){ |
| 219 | switch (pixf->pixenum){ |
| 220 | case ARGB1555: |
| 221 | case RGB565: |
| 222 | bpp = 16; |
| 223 | tocopy = 2; |
| 224 | break; |
| 225 | case ARGB: |
| 226 | bpp = 32; |
| 227 | tocopy = 4; |
| 228 | break; |
| 229 | default: |
| 230 | printf ("drawrect: unknown pixelformat(%d) bpp:%d\n",pixf->pixenum,pixf->bpp); |
| 231 | exit(1); |
| 232 | } |
| 233 | col2pixel(&pix,pixf,r->col); |
| 234 | } else { |
| 235 | switch (pixf->pixenum){ // CLUT = Colour LookUp Table (palette) |
| 236 | case CLUT4: // take red value as index in this case |
| 237 | pix.byte[0]=(r->col->r)<<4|(r->col->r&0xf); // slightly cryptic... "rect->colour->red" |
| 238 | corwidth>>=1; // we copy bytes |
| 239 | bpp=4; |
| 240 | tocopy=1; |
| 241 | break; |
| 242 | case CLUT8: |
| 243 | pix.byte[0]=(r->col->r&0xff); |
| 244 | bpp=8; |
| 245 | tocopy=1; |
| 246 | break; |
| 247 | } |
| 248 | } |
| 249 | pmem=videoram+((((r->y*vids->width)+r->x)*bpp)>>3); |
| 250 | for (y=0;y<r->height;y++){ |
| 251 | int offset = 0; |
| 252 | for (x=0;x<corwidth;x++){ |
| 253 | memcpy (pmem+offset,pix.byte,tocopy); |
| 254 | offset+=tocopy; |
| 255 | } |
| 256 | pmem +=((vids->width*bpp)>>3); // skip one whole line, actually should be taken from "fix-info" |
| 257 | } |
| 258 | } |
| 259 | |
| 260 | // create quick little test image, 4 colours from table |
| 261 | void draw4field(void *videoram, const struct pixelformat *pixf, const struct vidsize *vids){ |
| 262 | struct rect r; |
| 263 | struct colour c; |
| 264 | int height, width; |
| 265 | c.r = 1; // only used for the indexed modes, r is taken as index |
| 266 | height = vids->height; |
| 267 | width = vids->width; |
| 268 | |
| 269 | r.height = height>>1; |
| 270 | r.width = width>>1; |
| 271 | r.x = 0; r.y = 0; |
| 272 | if (pixf->pixenum==CLUT4||pixf->pixenum==CLUT8) r.col = &c; |
| 273 | else r.col = &colourtable[1]; |
| 274 | drawrect (videoram, &r, pixf, vids); |
| 275 | |
| 276 | r.x = width/2; r.y = 0; |
| 277 | if (pixf->pixenum==CLUT4||pixf->pixenum==CLUT8) c.r = 2; |
| 278 | else r.col = &colourtable[2]; |
| 279 | drawrect (videoram, &r, pixf, vids); |
| 280 | |
| 281 | r.x = 0; r.y = height/2; |
| 282 | if (pixf->pixenum==CLUT4||pixf->pixenum==CLUT8) c.r = 3; |
| 283 | else r.col = &colourtable[3]; |
| 284 | drawrect (videoram, &r, pixf, vids); |
| 285 | |
| 286 | r.x = width/2; r.y = height/2; |
| 287 | if (pixf->pixenum==CLUT4||pixf->pixenum==CLUT8) c.r = 0; |
| 288 | else r.col = &colourtable[0]; |
| 289 | drawrect (videoram, &r, pixf, vids); |
| 290 | } |
| 291 | |
| 292 | void usage(char *name){ |
| 293 | printf ("Usage: %s [options]\n" |
| 294 | "Options: -f<pixelformat>\n" |
| 295 | " where format is one of:\n" |
| 296 | " CLUT4,CLUT8,ARGB1555,RGB565,ARGB\n" |
| 297 | " -s<width>x<heigth>\n" |
| 298 | " where width is either 720,640,360,320\n" |
| 299 | " and height is either 288,240,480,576\n" |
| 300 | " -n\n" |
| 301 | " disables clearing the framebuffer after drawing\n" |
| 302 | " the testimage. This can be useful to keep the last\n" |
| 303 | " drawn image onscreen.\n" |
| 304 | "\nExample: %s -fRGB322\n",name,name); |
| 305 | exit(0); |
| 306 | } |
| 307 | |
| 308 | int main (int argc,char **argv){ |
| 309 | struct fb_fix_screeninfo fix; |
| 310 | struct fb_var_screeninfo var; |
| 311 | struct fb_cmap cmap; |
| 312 | struct rect r; |
| 313 | int fbd; |
| 314 | unsigned char *pfb; |
| 315 | int stat; |
| 316 | int optchar,fmode=-1,smode=-1,clear=1; |
| 317 | int i_cmap,i_size,i_pix; |
| 318 | extern char *optarg; |
| 319 | |
| 320 | if (argc!=0&&argc>4) usage(argv[0]); |
| 321 | while ( (optchar = getopt (argc,argv,"f:s:n"))!= -1){ |
| 322 | int i,height,width; |
| 323 | switch (optchar){ |
| 324 | case 'f': |
| 325 | for (i=0;i<(sizeof(pixname)/sizeof(char*));i++){ |
| 326 | if (!strncmp (optarg,pixname[i],strlen(pixname[i]))){ |
| 327 | fmode=i; |
| 328 | printf ("displaying only %s-modes\n",pixname[i]); |
| 329 | break; |
| 330 | } |
| 331 | } |
| 332 | if (fmode==-1){ |
| 333 | printf ("unknown pixelformat\n"); |
| 334 | exit(0); |
| 335 | } |
| 336 | break; |
| 337 | case 's': |
| 338 | if (sscanf (optarg,"%dx%d",&width,&height)!=2){ |
| 339 | printf ("parsing size failed\n"); |
| 340 | exit(0); |
| 341 | } else { |
| 342 | printf ("requested size %dx%d\n",width,height); |
| 343 | for (i=0;i<VIDSIZENUM;i++){ |
| 344 | if (vidsizetable[i].width == width && |
| 345 | vidsizetable[i].height == height){ |
| 346 | smode = i; |
| 347 | break; |
| 348 | } |
| 349 | } |
| 350 | if (smode==-1){ |
| 351 | printf ("this size is not supported\n"); |
| 352 | exit(0); |
| 353 | } |
| 354 | } |
| 355 | break; |
| 356 | case 'n': |
| 357 | clear = 0; |
| 358 | printf ("clearing framebuffer after drawing is disabled\n"); |
| 359 | break; |
| 360 | case '?': |
| 361 | usage (argv[0]); |
| 362 | } |
| 363 | } |
| 364 | |
| 365 | fbd = open (FBDEV, O_RDWR); |
| 366 | if (fbd<0){ |
| 367 | perror ("Error opening framebuffer device"); |
| 368 | return 1; |
| 369 | } |
| 370 | stat = ioctl (fbd, FBIOGET_FSCREENINFO,&fix); |
| 371 | if (stat<0){ |
| 372 | perror ("Error getting fix screeninfo"); |
| 373 | return 1; |
| 374 | } |
| 375 | stat = ioctl (fbd, FBIOGET_VSCREENINFO,&var); |
| 376 | if (stat<0){ |
| 377 | perror ("Error getting var screeninfo"); |
| 378 | return 1; |
| 379 | } |
| 380 | stat = ioctl (fbd, FBIOPUT_VSCREENINFO,&var); |
| 381 | if (stat<0){ |
| 382 | perror ("Error setting mode"); |
| 383 | return 1; |
| 384 | } |
| 385 | pfb = mmap (0, fix.smem_len, PROT_READ|PROT_WRITE, MAP_SHARED, fbd, 0); |
| 386 | if (pfb == MAP_FAILED){ |
| 387 | perror ("Error mmap'ing framebuffer device"); |
| 388 | return 1; |
| 389 | } |
| 390 | |
| 391 | // iterate over all modes |
| 392 | for (i_pix=0;i_pix<PIXELFORMATNUM;i_pix++){ |
| 393 | if (fmode!=-1 && pixelformattable[i_pix].pixenum != fmode) continue; |
| 394 | printf ("testing: %s",pixelformattable[i_pix].name); |
| 395 | printf (" for sizes: \n"); |
| 396 | for (i_size=0;i_size<VIDSIZENUM;i_size++){ |
| 397 | if (smode!=-1 && i_size!=smode) continue; |
| 398 | printf ("%dx%d ",vidsizetable[i_size].width,vidsizetable[i_size].height); |
| 399 | fflush(stdout); |
| 400 | if ((i_size%4)==3) printf ("\n"); |
| 401 | |
| 402 | // try to set mode |
| 403 | stat = setmode(fbd,&pixelformattable[i_pix],&vidsizetable[i_size]); |
| 404 | if (stat==-2) perror ("fbtest: could not get fb_var-screeninfo from fb-device"); |
| 405 | else if (stat==-1){ |
| 406 | printf ("\nCould not set mode %s (%dx%d), possible reasons:\n" |
| 407 | "- you have a GTX (soz m8)\n" |
| 408 | "- your configuration does not have enough graphics RAM\n" |
| 409 | "- you found a bug\n" |
| 410 | "choose your poison accordingly...\n", |
| 411 | pixelformattable[i_pix].name,vidsizetable[i_size].width,vidsizetable[i_size].height); |
| 412 | continue; |
| 413 | } |
| 414 | // fill cmap; |
| 415 | cmap.len = 1; |
| 416 | if ((pixelformattable[i_pix].bpp==4)|| |
| 417 | ((pixelformattable[i_pix].bpp==8)&&(pixelformattable[i_pix].red.length!=3))){ |
| 418 | for (i_cmap=0;i_cmap<COLOURNUM;i_cmap++){ |
| 419 | cmap.start=i_cmap; |
| 420 | cmap.red=&colourtable[i_cmap].r; |
| 421 | cmap.green=&colourtable[i_cmap].g; |
| 422 | cmap.blue=&colourtable[i_cmap].b; |
| 423 | cmap.transp=&colourtable[i_cmap].a; |
| 424 | stat = ioctl (fbd, FBIOPUTCMAP, &cmap); |
| 425 | if (stat<0) printf ("setting colourmap failed\n"); |
| 426 | } |
| 427 | } |
| 428 | // create the test image |
| 429 | draw4field(pfb,&pixelformattable[i_pix],&vidsizetable[i_size]); |
| 430 | usleep (500000); |
| 431 | // clear screen |
| 432 | if (clear){ |
| 433 | r.x=r.y=0;r.width = vidsizetable[i_size].width; r.height = vidsizetable[i_size].height; |
| 434 | r.col = &colourtable[4]; |
| 435 | drawrect(pfb,&r,&pixelformattable[i_pix],&vidsizetable[i_size]); |
| 436 | } |
| 437 | } |
| 438 | printf ("\n"); |
| 439 | } |
| 440 | |
| 441 | stat = munmap (pfb,fix.smem_len); |
| 442 | if (stat<0){ |
| 443 | perror ("Error munmap'ing framebuffer device"); |
| 444 | return 1; |
| 445 | } |
| 446 | close (fbd); |
| 447 | return 0; |
| 448 | } |
| 449 | |