util/mag_image.c

   1 #include "mag_image.h"
   2
   3
   4 static int get_num(char* msg);
   5 static void get_coord(char* msg,point *p);
   6 static void get_rect(char* msg, point *p1, point *p2);
   7 static void compute_center_coord(point p1, point p2, point *center);
   8 static xlib_colormap * xlib_get_colormap (Colormap id, Visual *visual, MagnifierData *data);
   9 static guint32 mask_table[] = {
  10         0x00000000, 0x00000001, 0x00000003, 0x00000007,
  11         0x0000000f, 0x0000001f, 0x0000003f, 0x0000007f,
  12         0x000000ff, 0x000001ff, 0x000003ff, 0x000007ff,
  13         0x00000fff, 0x00001fff, 0x00003fff, 0x00007fff,
  14         0x0000ffff, 0x0001ffff, 0x0003ffff, 0x0007ffff,
  15         0x000fffff, 0x001fffff, 0x003fffff, 0x007fffff,
  16         0x00ffffff, 0x01ffffff, 0x03ffffff, 0x07ffffff,
  17         0x0fffffff, 0x1fffffff, 0x3fffffff, 0x7fffffff,
  18         0xffffffff
  19 };
  20
  21 void parse_message(char *msg, MagnifierData *data){
  22
  23   int type;
  24   point roi_pos, roi_size;
  25   point mag_pos, mag_size;
  26
  27   printf("%s\n",msg);
  28   if(msg[0] != '~'){
  29     fprintf(stderr,"corrupted message, discarding\n");
  30     return;
  31   }
  32   type = atoi((char*)&msg[1]);
  33   switch (type){
  34         case FACTOR :
  35             old_factor_x = data->factor_x;
  36             data->factor_x = get_num(msg);
  37             old_factor_y = data->factor_y;
  38             data->factor_y = get_num(msg);
  39             printf("FACTOR = %d\n",data->factor_x);
  40             break;
  41         case CONTRAST :
  42             data->contrast = get_num(msg);
  43             printf("CONTRAST = %d\n",data->contrast);
  44             break;
  45         case FOLLOW_MOUSE :
  46             data->follow_mouse = get_num(msg);
  47             printf("FOLLOW_MOUSE = %d\n",data->follow_mouse);
  48             break;
  49         case COLOR_INVERTED :
  50             data->color_inverted = get_num(msg);
  51             printf("COLOR_INVERTED = %d\n",data->color_inverted);
  52             break;
  53         case GOTO :
  54             get_coord(msg, &data->center);
  55             printf("GOTO = (%d,%d)\n", data->center.x, data->center.y);
  56             break;
  57         case SET_ROI:
  58             get_rect (msg, &roi_pos, &roi_size);
  59             printf("ROI = (%d,%d; %d,%d)\n", roi_pos.x, roi_pos.y, roi_size.x, roi_size.y);
  60             compute_center_coord (roi_pos, roi_size, &data->center);
  61             break;
  62         case SET_EXTENTS:
  63             get_rect (msg, &mag_pos, &mag_size);
  64             printf("EXTENTS = (%d,%d; %d,%d)\n", mag_pos.x, mag_pos.y, mag_size.x, mag_size.y);
  65             data->mag_width = mag_size.x;
  66             data->mag_height = mag_size.y;
  67             gdk_window_move_resize (data->output_window->window, mag_pos.x,
  68                                     mag_pos.y,
  69                                     data->mag_width, data->mag_height);
  70             break;
  71         case STOP :
  72             printf("STOP\n");
  73             gtk_main_quit();
  74             break;
  75         default:
  76             break;
  77   }
  78 }
  79
  80
  81 static int get_num(char* msg){
  82  int type,num;
  83  sscanf(msg,"~%d:%d:",&type,&num);
  84  return num;
  85 }
  86
  87 static void get_coord(char* msg,point *p){
  88  int type;
  89  sscanf(msg,"~%d:%d,%d:",&type,&p->x,&p->y);
  90 }
  91
  92 static void get_rect(char* msg, point *p1, point *p2){
  93  int type;
  94  sscanf(msg,"~%d:%d,%d;%d,%d:",&type, &p1->x, &p1->y, &p2->x, &p2->y);
  95 }
  96
  97 static void compute_center_coord (point pos, point size, point *center) {
  98   center->x = pos.x + (size.x/2);
  99   center->y = pos.y + (size.y/2);
 100 }
 101
 102 int display_image(gpointer data)
 103 {
 104   MagnifierData *mag_data = (MagnifierData *)data;
 105   update_image(mag_data);
 106   gdk_pixbuf_scale(image,
 107                    scaled_image,
 108                    0,
 109                    0,
 110                    DisplayWidth (mag_data->target_display,screen_num),
 111                    DisplayHeight(mag_data->target_display,screen_num),
 112                    0,
 113                    0,
 114                    mag_data->factor_x,
 115                    mag_data->factor_y,
 116                    GDK_INTERP_NEAREST);
 117
 118   gdk_pixbuf_render_to_drawable (scaled_image,
 119                         drawing_area->window,
 120                         drawing_area->style->fg_gc[GTK_STATE_NORMAL],
 121                         0,0,0,0,DisplayWidth (mag_data->target_display,screen_num),
 122                         DisplayHeight(mag_data->target_display,screen_num),
 123                         GDK_RGB_DITHER_NORMAL,0,0);
 124   /* TODO: raise this window to top on refresh */
 125   return TRUE;
 126 }
 127
 128 void update_image(MagnifierData *mag_data)
 129 {
 130  int x, y, total_width, total_height;
 131
 132  if(mag_data->follow_mouse){
 133     Window root_return, child_return;
 134     int win_x_return,win_y_return;
 135     unsigned int mask_return;
 136     XQueryPointer(mag_data->source_display,spi_image_root_window,
 137                   &root_return,&child_return,
 138                   &mag_data->center.x,&mag_data->center.y,
 139                   &win_x_return,&win_y_return,&mask_return);
 140   }
 141
 142   total_width = DisplayWidth (mag_data->source_display,screen_num);
 143   total_height = DisplayHeight(mag_data->source_display,screen_num);
 144
 145   x = mag_data->center.x - mag_data->mag_width/mag_data->factor_x/2;
 146   y = mag_data->center.y - mag_data->mag_height/mag_data->factor_y/2;
 147
 148   if(mag_data->center.x < mag_data->mag_width/mag_data->factor_x/2)
 149     x = 0;
 150   if(mag_data->center.x > (total_width - mag_data->mag_width/mag_data->factor_x/2))
 151     x = total_width - mag_data->mag_width/mag_data->factor_x;
 152   if(mag_data->center.y < mag_data->mag_height/mag_data->factor_y/2)
 153     y = 0;
 154   if(mag_data->center.y > (total_height - mag_data->mag_height/mag_data->factor_y/2))
 155     y = total_height - mag_data->mag_height/mag_data->factor_y;
 156   if(x < 0)
 157     x = 0;
 158   if(y < 0)
 159     y = 0;
 160 /*
 161   printf("p = (%d,%d), x,y = (%d,%d), h,w = (%d,%d), ht,wt = (%d,%d)\n",
 162                                         mag_data->center.x,
 163                                         mag_data->center.y,
 164                                         x,y,
 165                                         mag_data->mag_height,mag_data->mag_width,
 166                                         total_height,
 167                                         total_width);
 168 */
 169   if(mag_data->factor_x != old_factor_x || mag_data->factor_y != old_factor_y){
 170     g_object_unref((GObject *)image);
 171     image = gdk_pixbuf_new (GDK_COLORSPACE_RGB,FALSE, 8,
 172                                 DisplayWidth (mag_data->target_display,screen_num)/mag_data->factor_x,
 173                                 DisplayHeight(mag_data->target_display,screen_num)/mag_data->factor_y);
 174     /* yes, use target display above, since the size of the area grabbed depends on the target */
 175     old_factor_x = mag_data->factor_x;
 176     old_factor_y = mag_data->factor_y;
 177   }
 178   get_root_image(spi_image_root_window,
 179                  image,
 180                  x,
 181                  y,
 182                  mag_data);
 183 }
 184 void expose_event(GtkWidget * w, GdkEventExpose *event, gpointer data){
 185
 186 }
 187
 188
 189
 190
 191 /* SpiImage grabbing and convertion routines from gdk-pixbuf-xlib */
 192 /*
 193   convert 1 bits-pixel data
 194   no alpha
 195 */
 196 static void
 197 rgb1 (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 198 {
 199         int xx, yy;
 200         int width, height;
 201         int bpl;
 202         guint8 *s;
 203         register guint8 data;
 204         guint8 *o;
 205         guint8 *srow = image->data, *orow = pixels;
 206
 207         /* convert upto 8 pixels/time */
 208         /* its probably not worth trying to make this run very fast, who uses
 209            1 bit displays anymore? */
 210         width = image->width;
 211         height = image->height;
 212         bpl = image->bytes_per_line;
 213
 214         for (yy = 0; yy < height; yy++) {
 215                 s = srow;
 216                 o = orow;
 217
 218                 for (xx = 0; xx < width; xx ++) {
 219                         data = srow[xx >> 3] >> (7 - (xx & 7)) & 1;
 220                         *o++ = colormap->colors[data].red;
 221                         *o++ = colormap->colors[data].green;
 222                         *o++ = colormap->colors[data].blue;
 223                 }
 224                 srow += bpl;
 225                 orow += rowstride;
 226         }
 227 }
 228
 229 /*
 230   convert 1 bits/pixel data
 231   with alpha
 232 */
 233 static void
 234 rgb1a (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 235 {
 236         int xx, yy;
 237         int width, height;
 238         int bpl;
 239         guint8 *s;
 240         register guint8 data;
 241         guint8 *o;
 242         guint8 *srow = image->data, *orow = pixels;
 243         guint32 remap[2];
 244
 245         /* convert upto 8 pixels/time */
 246         /* its probably not worth trying to make this run very fast, who uses
 247            1 bit displays anymore? */
 248         width = image->width;
 249         height = image->height;
 250         bpl = image->bytes_per_line;
 251
 252         for (xx = 0; xx < 2; xx++) {
 253 #ifdef LITTLE
 254                 remap[xx] = 0xff000000
 255                         | colormap->colors[xx].blue << 16
 256                         | colormap->colors[xx].green << 8
 257                         | colormap->colors[xx].red;
 258 #else
 259                 remap[xx] = 0xff
 260                         | colormap->colors[xx].red << 24
 261                         | colormap->colors[xx].green << 16
 262                         | colormap->colors[xx].blue << 8;
 263 #endif
 264         }
 265
 266         for (yy = 0; yy < height; yy++) {
 267                 s = srow;
 268                 o = orow;
 269
 270                 for (xx = 0; xx < width; xx ++) {
 271                         data = srow[xx >> 3] >> (7 - (xx & 7)) & 1;
 272                         *o++ = remap[data];
 273                 }
 274                 srow += bpl;
 275                 orow += rowstride;
 276         }
 277 }
 278
 279 /*
 280   convert 8 bits/pixel data
 281   no alpha
 282 */
 283 static void
 284 rgb8 (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 285 {
 286         int xx, yy;
 287         int width, height;
 288         int bpl;
 289         guint32 mask;
 290         register guint32 data;
 291         guint8 *srow = image->data, *orow = pixels;
 292         register guint8 *s;
 293         register guint8 *o;
 294
 295         width = image->width;
 296         height = image->height;
 297         bpl = image->bytes_per_line;
 298
 299         mask = mask_table[image->depth];
 300
 301         for (yy = 0; yy < height; yy++) {
 302                 s = srow;
 303                 o = orow;
 304                 for (xx = 0; xx < width; xx++) {
 305                         data = *s++ & mask;
 306                         *o++ = colormap->colors[data].red;
 307                         *o++ = colormap->colors[data].green;
 308                         *o++ = colormap->colors[data].blue;
 309                 }
 310                 srow += bpl;
 311                 orow += rowstride;
 312         }
 313 }
 314
 315 /*
 316   convert 8 bits/pixel data
 317   with alpha
 318 */
 319 static void
 320 rgb8a (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 321 {
 322         int xx, yy;
 323         int width, height;
 324         int bpl;
 325         guint32 mask;
 326         register guint32 data;
 327         guint32 remap[256];
 328         register guint8 *s;     /* read 2 pixels at once */
 329         register guint32 *o;
 330         guint8 *srow = image->data, *orow = pixels;
 331
 332         width = image->width;
 333         height = image->height;
 334         bpl = image->bytes_per_line;
 335
 336         mask = mask_table[image->depth];
 337
 338         for (xx = 0; xx < colormap->size; xx++) {
 339 #ifdef LITTLE
 340                 remap[xx] = 0xff000000
 341                         | colormap->colors[xx].blue << 16
 342                         | colormap->colors[xx].green << 8
 343                         | colormap->colors[xx].red;
 344 #else
 345                 remap[xx] = 0xff
 346                         | colormap->colors[xx].red << 24
 347                         | colormap->colors[xx].green << 16
 348                         | colormap->colors[xx].blue << 8;
 349 #endif
 350         }
 351
 352         for (yy = 0; yy < height; yy++) {
 353                 s = srow;
 354                 o = (guint32 *) orow;
 355                 for (xx = 0; xx < width; xx ++) {
 356                         data = *s++ & mask;
 357                         *o++ = remap[data];
 358                 }
 359                 srow += bpl;
 360                 orow += rowstride;
 361         }
 362 }
 363
 364 /*
 365   convert 16 bits/pixel data
 366   no alpha
 367   data in lsb format
 368 */
 369 static void
 370 rgb565lsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 371 {
 372         int xx, yy;
 373         int width, height;
 374         int bpl;
 375
 376 #ifdef LITTLE
 377         register guint32 *s;    /* read 2 pixels at once */
 378 #else
 379         register guint8 *s;     /* read 2 pixels at once */
 380 #endif
 381         register guint16 *o;
 382         guint8 *srow = image->data, *orow = pixels;
 383
 384         width = image->width;
 385         height = image->height;
 386         bpl = image->bytes_per_line;
 387
 388         for (yy = 0; yy < height; yy++) {
 389 #ifdef LITTLE
 390                 s = (guint32 *) srow;
 391 #else
 392                 s = srow;
 393 #endif
 394                 o = (guint16 *) orow;
 395                 for (xx = 1; xx < width; xx += 2) {
 396                         register guint32 data;
 397 #ifdef LITTLE
 398                         data = *s++;
 399                         *o++ = (data & 0xf800) >> 8 | (data & 0xe000) >> 13
 400                                 | (data & 0x7e0) << 5 | (data & 0x600) >> 1;
 401                         *o++ = (data & 0x1f) << 3 | (data & 0x1c) >> 2
 402                                 | (data & 0xf8000000) >> 16 | (data & 0xe0000000) >> 21;
 403                         *o++ = (data & 0x7e00000) >> 19 | (data & 0x6000000) >> 25
 404                                 | (data & 0x1f0000) >> 5 | (data & 0x1c0000) >> 10;
 405 #else
 406                         /* swap endianness first */
 407                         data = s[0] | s[1] << 8 | s[2] << 16 | s[3] << 24;
 408                         s += 4;
 409                         *o++ = (data & 0xf800) | (data & 0xe000) >> 5
 410                                 | (data & 0x7e0) >> 3 | (data & 0x600) >> 9;
 411                         *o++ = (data & 0x1f) << 11 | (data & 0x1c) << 6
 412                                 | (data & 0xf8000000) >> 24 | (data & 0xe0000000) >> 29;
 413                         *o++ = (data & 0x7e00000) >> 11 | (data & 0x6000000) >> 17
 414                                 | (data & 0x1f0000) >> 13 | (data & 0x1c0000) >> 18;
 415 #endif
 416                 }
 417                 /* check for last remaining pixel */
 418                 if (width & 1) {
 419                         register guint16 data;
 420 #ifdef LITTLE
 421                         data = *((short *) s);
 422 #else
 423                         data = *((short *) s);
 424                         data = ((data >> 8) & 0xff) | ((data & 0xff) << 8);
 425 #endif
 426                         ((char *) o)[0] = ((data >> 8) & 0xf8) | ((data >> 13) & 0x7);
 427                         ((char *) o)[1] = ((data >> 3) & 0xfc) | ((data >> 9) & 0x3);
 428                         ((char *) o)[2] = ((data << 3) & 0xf8) | ((data >> 2) & 0x7);
 429                 }
 430                 srow += bpl;
 431                 orow += rowstride;
 432         }
 433 }
 434
 435 /*
 436   convert 16 bits/pixel data
 437   no alpha
 438   data in msb format
 439 */
 440 static void
 441 rgb565msb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 442 {
 443         int xx, yy;
 444         int width, height;
 445         int bpl;
 446
 447 #ifdef LITTLE
 448         register guint8 *s;     /* need to swap data order */
 449 #else
 450         register guint32 *s;    /* read 2 pixels at once */
 451 #endif
 452         register guint16 *o;
 453         guint8 *srow = image->data, *orow = pixels;
 454
 455         width = image->width;
 456         height = image->height;
 457         bpl = image->bytes_per_line;
 458
 459         for (yy = 0; yy < height; yy++) {
 460 #ifdef LITTLE
 461                 s = srow;
 462 #else
 463                 s = (guint32 *) srow;
 464 #endif
 465                 o = (guint16 *) orow;
 466                 for (xx = 1; xx < width; xx += 2) {
 467                         register guint32 data;
 468 #ifdef LITTLE
 469                         /* swap endianness first */
 470                         data = s[0] | s[1] << 8 | s[2] << 16 | s[3] << 24;
 471                         s += 4;
 472                         *o++ = (data & 0xf800) >> 8 | (data & 0xe000) >> 13
 473                                 | (data & 0x7e0) << 5 | (data & 0x600) >> 1;
 474                         *o++ = (data & 0x1f) << 3 | (data & 0x1c) >> 2
 475                                 | (data & 0xf8000000) >> 16 | (data & 0xe0000000) >> 21;
 476                         *o++ = (data & 0x7e00000) >> 19 | (data & 0x6000000) >> 25
 477                                 | (data & 0x1f0000) >> 5 | (data & 0x1c0000) >> 10;
 478 #else
 479                         data = *s++;
 480                         *o++ = (data & 0xf800) | (data & 0xe000) >> 5
 481                                 | (data & 0x7e0) >> 3 | (data & 0x600) >> 9;
 482                         *o++ = (data & 0x1f) << 11 | (data & 0x1c) << 6
 483                                 | (data & 0xf8000000) >> 24 | (data & 0xe0000000) >> 29;
 484                         *o++ = (data & 0x7e00000) >> 11 | (data & 0x6000000) >> 17
 485                                 | (data & 0x1f0000) >> 13 | (data & 0x1c0000) >> 18;
 486 #endif
 487                 }
 488                 /* check for last remaining pixel */
 489                 if (width & 1) {
 490                         register guint16 data;
 491 #ifdef LITTLE
 492                         data = *((short *) s);
 493                         data = ((data >> 8) & 0xff) | ((data & 0xff) << 8);
 494 #else
 495                         data = *((short *) s);
 496 #endif
 497                         ((char *) o)[0] = ((data >> 8) & 0xf8) | ((data >> 13) & 0x7);
 498                         ((char *) o)[1] = ((data >> 3) & 0xfc) | ((data >> 9) & 0x3);
 499                         ((char *) o)[2] = ((data << 3) & 0xf8) | ((data >> 2) & 0x7);
 500                 }
 501                 srow += bpl;
 502                 orow += rowstride;
 503         }
 504 }
 505
 506 /*
 507   convert 16 bits/pixel data
 508   with alpha
 509   data in lsb format
 510 */
 511 static void
 512 rgb565alsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 513 {
 514         int xx, yy;
 515         int width, height;
 516         int bpl;
 517
 518 #ifdef LITTLE
 519         register guint16 *s;    /* read 1 pixels at once */
 520 #else
 521         register guint8 *s;
 522 #endif
 523         register guint32 *o;
 524
 525         guint8 *srow = image->data, *orow = pixels;
 526
 527         width = image->width;
 528         height = image->height;
 529         bpl = image->bytes_per_line;
 530
 531         for (yy = 0; yy < height; yy++) {
 532 #ifdef LITTLE
 533                 s = (guint16 *) srow;
 534 #else
 535                 s = (guint8 *) srow;
 536 #endif
 537                 o = (guint32 *) orow;
 538                 for (xx = 0; xx < width; xx ++) {
 539                         register guint32 data;
 540                         /*  rrrrrggg gggbbbbb -> rrrrrRRR ggggggGG bbbbbBBB aaaaaaaa */
 541                         /*  little endian: aaaaaaaa bbbbbBBB ggggggGG rrrrrRRR */
 542 #ifdef LITTLE
 543                         data = *s++;
 544                         *o++ = (data & 0xf800) >> 8 | (data & 0xe000) >> 13
 545                                 | (data & 0x7e0) << 5 | (data & 0x600) >> 1
 546                                 | (data & 0x1f) << 19 | (data & 0x1c) << 14
 547                                 | 0xff000000;
 548 #else
 549                         /* swap endianness first */
 550                         data = s[0] | s[1] << 8;
 551                         s += 2;
 552                         *o++ = (data & 0xf800) << 16 | (data & 0xe000) << 11
 553                                 | (data & 0x7e0) << 13 | (data & 0x600) << 7
 554                                 | (data & 0x1f) << 11 | (data & 0x1c) << 6
 555                                 | 0xff;
 556 #endif
 557                 }
 558                 srow += bpl;
 559                 orow += rowstride;
 560         }
 561 }
 562
 563 /*
 564   convert 16 bits/pixel data
 565   with alpha
 566   data in msb format
 567 */
 568 static void
 569 rgb565amsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 570 {
 571         int xx, yy;
 572         int width, height;
 573         int bpl;
 574
 575 #ifdef LITTLE
 576         register guint8 *s;
 577 #else
 578         register guint16 *s;    /* read 1 pixels at once */
 579 #endif
 580         register guint32 *o;
 581
 582         guint8 *srow = image->data, *orow = pixels;
 583
 584         width = image->width;
 585         height = image->height;
 586         bpl = image->bytes_per_line;
 587
 588         for (yy = 0; yy < height; yy++) {
 589                 s = srow;
 590                 o = (guint32 *) orow;
 591                 for (xx = 0; xx < width; xx ++) {
 592                         register guint32 data;
 593                         /*  rrrrrggg gggbbbbb -> rrrrrRRR gggggg00 bbbbbBBB aaaaaaaa */
 594                         /*  little endian: aaaaaaaa bbbbbBBB gggggg00 rrrrrRRR */
 595 #ifdef LITTLE
 596                         /* swap endianness first */
 597                         data = s[0] | s[1] << 8;
 598                         s += 2;
 599                         *o++ = (data & 0xf800) >> 8 | (data & 0xe000) >> 13
 600                                 | (data & 0x7e0) << 5 | (data & 0x600) >> 1
 601                                 | (data & 0x1f) << 19 | (data & 0x1c) << 14
 602                                 | 0xff000000;
 603 #else
 604                         data = *s++;
 605                         *o++ = (data & 0xf800) << 16 | (data & 0xe000) << 11
 606                                 | (data & 0x7e0) << 13 | (data & 0x600) << 7
 607                                 | (data & 0x1f) << 11 | (data & 0x1c) << 6
 608                                 | 0xff;
 609 #endif
 610                 }
 611                 srow += bpl;
 612                 orow += rowstride;
 613         }
 614 }
 615
 616 /*
 617   convert 15 bits/pixel data
 618   no alpha
 619   data in lsb format
 620 */
 621 static void
 622 rgb555lsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 623 {
 624         int xx, yy;
 625         int width, height;
 626         int bpl;
 627
 628 #ifdef LITTLE
 629         register guint32 *s;    /* read 2 pixels at once */
 630 #else
 631         register guint8 *s;     /* read 2 pixels at once */
 632 #endif
 633         register guint16 *o;
 634         guint8 *srow = image->data, *orow = pixels;
 635
 636         width = image->width;
 637         height = image->height;
 638         bpl = image->bytes_per_line;
 639
 640         for (yy = 0; yy < height; yy++) {
 641 #ifdef LITTLE
 642                 s = (guint32 *) srow;
 643 #else
 644                 s = srow;
 645 #endif
 646                 o = (guint16 *) orow;
 647                 for (xx = 1; xx < width; xx += 2) {
 648                         register guint32 data;
 649 #ifdef LITTLE
 650                         data = *s++;
 651                         *o++ = (data & 0x7c00) >> 7 | (data & 0x7000) >> 12
 652                                 | (data & 0x3e0) << 6 | (data & 0x380) << 1;
 653                         *o++ = (data & 0x1f) << 3 | (data & 0x1c) >> 2
 654                                 | (data & 0x7c000000) >> 15 | (data & 0x70000000) >> 20;
 655                         *o++ = (data & 0x3e00000) >> 18 | (data & 0x3800000) >> 23
 656                                 | (data & 0x1f0000) >> 5 | (data & 0x1c0000) >> 10;
 657 #else
 658                         /* swap endianness first */
 659                         data = s[0] | s[1] << 8 | s[2] << 16 | s[3] << 24;
 660                         s += 4;
 661                         *o++ = (data & 0x7c00) << 1 | (data & 0x7000) >> 4
 662                                 | (data & 0x3e0) >> 2 | (data & 0x380) >> 7;
 663                         *o++ = (data & 0x1f) << 11 | (data & 0x1c) << 6
 664                                 | (data & 0x7c000000) >> 23 | (data & 0x70000000) >> 28;
 665                         *o++ = (data & 0x3e00000) >> 10 | (data & 0x3800000) >> 15
 666                                 | (data & 0x1f0000) >> 13 | (data & 0x1c0000) >> 18;
 667 #endif
 668                 }
 669                 /* check for last remaining pixel */
 670                 if (width & 1) {
 671                         register guint16 data;
 672 #ifdef LITTLE
 673                         data = *((short *) s);
 674 #else
 675                         data = *((short *) s);
 676                         data = ((data >> 8) & 0xff) | ((data & 0xff) << 8);
 677 #endif
 678                         ((char *) o)[0] = (data & 0x7c00) >> 7 | (data & 0x7000) >> 12;
 679                         ((char *) o)[1] = (data & 0x3e0) >> 2 | (data & 0x380) >> 7;
 680                         ((char *) o)[2] = (data & 0x1f) << 3 | (data & 0x1c) >> 2;
 681                 }
 682                 srow += bpl;
 683                 orow += rowstride;
 684         }
 685 }
 686
 687 /*
 688   convert 15 bits/pixel data
 689   no alpha
 690   data in msb format
 691 */
 692 static void
 693 rgb555msb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 694 {
 695         int xx, yy;
 696         int width, height;
 697         int bpl;
 698
 699 #ifdef LITTLE
 700         register guint8 *s;     /* read 2 pixels at once */
 701 #else
 702         register guint32 *s;    /* read 2 pixels at once */
 703 #endif
 704         register guint16 *o;
 705         guint8 *srow = image->data, *orow = pixels;
 706
 707         width = image->width;
 708         height = image->height;
 709         bpl = image->bytes_per_line;
 710
 711         for (yy = 0; yy < height; yy++) {
 712                 s = srow;
 713                 o = (guint16 *) orow;
 714                 for (xx = 1; xx < width; xx += 2) {
 715                         register guint32 data;
 716 #ifdef LITTLE
 717                         /* swap endianness first */
 718                         data = s[0] | s[1] << 8 | s[2] << 16 | s[3] << 24;
 719                         s += 4;
 720                         *o++ = (data & 0x7c00) >> 7 | (data & 0x7000) >> 12
 721                                 | (data & 0x3e0) << 6 | (data & 0x380) << 1;
 722                         *o++ = (data & 0x1f) << 3 | (data & 0x1c) >> 2
 723                                 | (data & 0x7c000000) >> 15 | (data & 0x70000000) >> 20;
 724                         *o++ = (data & 0x3e00000) >> 18 | (data & 0x3800000) >> 23
 725                                 | (data & 0x1f0000) >> 5 | (data & 0x1c0000) >> 10;
 726 #else
 727                         data = *s++;
 728                         *o++ = (data & 0x7c00) << 1 | (data & 0x7000) >> 4
 729                                 | (data & 0x3e0) >> 2 | (data & 0x380) >> 7;
 730                         *o++ = (data & 0x1f) << 11 | (data & 0x1c) << 6
 731                                 | (data & 0x7c000000) >> 23 | (data & 0x70000000) >> 28;
 732                         *o++ = (data & 0x3e00000) >> 10 | (data & 0x3800000) >> 15
 733                                 | (data & 0x1f0000) >> 13 | (data & 0x1c0000) >> 18;
 734 #endif
 735                 }
 736                 /* check for last remaining pixel */
 737                 if (width & 1) {
 738                         register guint16 data;
 739 #ifdef LITTLE
 740                         data = *((short *) s);
 741                         data = ((data >> 8) & 0xff) | ((data & 0xff) << 8);
 742 #else
 743                         data = *((short *) s);
 744 #endif
 745                         ((char *) o)[0] = (data & 0x7c00) >> 7 | (data & 0x7000) >> 12;
 746                         ((char *) o)[1] = (data & 0x3e0) >> 2 | (data & 0x380) >> 7;
 747                         ((char *) o)[2] = (data & 0x1f) << 3 | (data & 0x1c) >> 2;
 748                 }
 749                 srow += bpl;
 750                 orow += rowstride;
 751         }
 752 }
 753
 754 /*
 755   convert 15 bits/pixel data
 756   with alpha
 757   data in lsb format
 758 */
 759 static void
 760 rgb555alsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 761 {
 762         int xx, yy;
 763         int width, height;
 764         int bpl;
 765
 766 #ifdef LITTLE
 767         register guint16 *s;    /* read 1 pixels at once */
 768 #else
 769         register guint8 *s;
 770 #endif
 771         register guint32 *o;
 772
 773         guint8 *srow = image->data, *orow = pixels;
 774
 775         width = image->width;
 776         height = image->height;
 777         bpl = image->bytes_per_line;
 778
 779         for (yy = 0; yy < height; yy++) {
 780 #ifdef LITTLE
 781                 s = (guint16 *) srow;
 782 #else
 783                 s = srow;
 784 #endif
 785                 o = (guint32 *) orow;
 786                 for (xx = 0; xx < width; xx++) {
 787                         register guint32 data;
 788                         /*  rrrrrggg gggbbbbb -> rrrrrRRR gggggGGG bbbbbBBB aaaaaaaa */
 789                         /*  little endian: aaaaaaaa bbbbbBBB gggggGGG rrrrrRRR */
 790 #ifdef LITTLE
 791                         data = *s++;
 792                         *o++ = (data & 0x7c00) >> 7 | (data & 0x7000) >> 12
 793                                 | (data & 0x3e0) << 6 | (data & 0x380) << 1
 794                                 | (data & 0x1f) << 19 | (data & 0x1c) << 14
 795                                 | 0xff000000;
 796 #else
 797                         /* swap endianness first */
 798                         data = s[0] | s[1] << 8;
 799                         s += 2;
 800                         *o++ = (data & 0x7c00) << 17 | (data & 0x7000) << 12
 801                                 | (data & 0x3e0) << 14 | (data & 0x380) << 9
 802                                 | (data & 0x1f) << 11 | (data & 0x1c) << 6
 803                                 | 0xff;
 804 #endif
 805                 }
 806                 srow += bpl;
 807                 orow += rowstride;
 808         }
 809 }
 810
 811 /*
 812   convert 15 bits/pixel data
 813   with alpha
 814   data in msb format
 815 */
 816 static void
 817 rgb555amsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 818 {
 819         int xx, yy;
 820         int width, height;
 821         int bpl;
 822
 823 #ifdef LITTLE
 824         register guint16 *s;    /* read 1 pixels at once */
 825 #else
 826         register guint8 *s;
 827 #endif
 828         register guint32 *o;
 829
 830         guint8 *srow = image->data, *orow = pixels;
 831
 832         width = image->width;
 833         height = image->height;
 834         bpl = image->bytes_per_line;
 835
 836         for (yy = 0; yy < height; yy++) {
 837 #ifdef LITTLE
 838                 s = (guint16 *) srow;
 839 #else
 840                 s = srow;
 841 #endif
 842                 o = (guint32 *) orow;
 843                 for (xx = 0; xx < width; xx++) {
 844                         register guint32 data;
 845                         /*  rrrrrggg gggbbbbb -> rrrrrRRR gggggGGG bbbbbBBB aaaaaaaa */
 846                         /*  little endian: aaaaaaaa bbbbbBBB gggggGGG rrrrrRRR */
 847 #ifdef LITTLE
 848                         /* swap endianness first */
 849                         data = s[0] | s[1] << 8;
 850                         s += 2;
 851                         *o++ = (data & 0x7c00) >> 7 | (data & 0x7000) >> 12
 852                                 | (data & 0x3e0) << 6 | (data & 0x380) << 1
 853                                 | (data & 0x1f) << 19 | (data & 0x1c) << 14
 854                                 | 0xff000000;
 855 #else
 856                         data = *s++;
 857                         *o++ = (data & 0x7c00) << 17 | (data & 0x7000) << 12
 858                                 | (data & 0x3e0) << 14 | (data & 0x380) << 9
 859                                 | (data & 0x1f) << 11 | (data & 0x1c) << 6
 860                                 | 0xff;
 861 #endif
 862                 }
 863                 srow += bpl;
 864                 orow += rowstride;
 865         }
 866 }
 867
 868
 869 static void
 870 rgb888alsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 871 {
 872         int xx, yy;
 873         int width, height;
 874         int bpl;
 875
 876         guint8 *s;      /* for byte order swapping */
 877         guint8 *o;
 878         guint8 *srow = image->data, *orow = pixels;
 879
 880         width = image->width;
 881         height = image->height;
 882         bpl = image->bytes_per_line;
 883
 884         /* lsb data */
 885         for (yy = 0; yy < height; yy++) {
 886                 s = srow;
 887                 o = orow;
 888                 for (xx = 0; xx < width; xx++) {
 889                         *o++ = s[2];
 890                         *o++ = s[1];
 891                         *o++ = s[0];
 892                         *o++ = 0xff;
 893                         s += 4;
 894                 }
 895                 srow += bpl;
 896                 orow += rowstride;
 897         }
 898 }
 899
 900 static void
 901 rgb888lsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 902 {
 903         int xx, yy;
 904         int width, height;
 905         int bpl;
 906
 907         guint8 *srow = image->data, *orow = pixels;
 908         guint8 *o, *s;
 909
 910         width = image->width;
 911         height = image->height;
 912         bpl = image->bytes_per_line;
 913
 914
 915         for (yy = 0; yy < height; yy++) {
 916                 s = srow;
 917                 o = orow;
 918                 for (xx = 0; xx < width; xx++) {
 919                         *o++ = s[2];
 920                         *o++ = s[1];
 921                         *o++ = s[0];
 922                         s += 4;
 923                 }
 924                 srow += bpl;
 925                 orow += rowstride;
 926         }
 927 }
 928
 929 static void
 930 rgb888amsb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 931 {
 932         int xx, yy;
 933         int width, height;
 934         int bpl;
 935
 936         guint8 *srow = image->data, *orow = pixels;
 937 #ifdef LITTLE
 938         guint32 *o;
 939         guint32 *s;
 940 #else
 941         guint8 *s;      /* for byte order swapping */
 942         guint8 *o;
 943 #endif
 944
 945
 946         width = image->width;
 947         height = image->height;
 948         bpl = image->bytes_per_line;
 949
 950         /* msb data */
 951         for (yy = 0; yy < height; yy++) {
 952 #ifdef LITTLE
 953                 s = (guint32 *) srow;
 954                 o = (guint32 *) orow;
 955 #else
 956                 s = srow;
 957                 o = orow;
 958 #endif
 959                 for (xx = 0; xx < width; xx++) {
 960 #ifdef LITTLE
 961                         *o++ = s[1];
 962                         *o++ = s[2];
 963                         *o++ = s[3];
 964                         *o++ = 0xff;
 965                         s += 4;
 966 #else
 967                         *o++ = (*s << 8) | 0xff; /* untested */
 968                         s++;
 969 #endif
 970                 }
 971                 srow += bpl;
 972                 orow += rowstride;
 973         }
 974 }
 975
 976 static void
 977 rgb888msb (XImage *image, guchar *pixels, int rowstride, xlib_colormap *colormap)
 978 {
 979         int xx, yy;
 980         int width, height;
 981         int bpl;
 982
 983         guint8 *srow = image->data, *orow = pixels;
 984         guint8 *s;
 985         guint8 *o;
 986
 987
 988         width = image->width;
 989         height = image->height;
 990         bpl = image->bytes_per_line;
 991
 992         for (yy = 0; yy < height; yy++) {
 993                 s = srow;
 994                 o = orow;
 995                 for (xx = 0; xx < width; xx++) {
 996                         *o++ = s[1];
 997                         *o++ = s[2];
 998                         *o++ = s[3];
 999                         s += 4;
1000                 }
1001                 srow += bpl;
1002                 orow += rowstride;
1003         }
1004 }
1005 static void
1006 visual_decompose_mask (gulong  mask,
1007                        gint   *shift,
1008                        gint   *prec)
1009 {
1010         *shift = 0;
1011         *prec = 0;
1012
1013         while (!(mask & 0x1)) {
1014                 (*shift)++;
1015                 mask >>= 1;
1016         }
1017
1018         while (mask & 0x1) {
1019                 (*prec)++;
1020                 mask >>= 1;
1021         }
1022 }
1023
1024
1025 /*
1026   This should work correctly with any display/any endianness, but will probably
1027   run quite slow
1028 */
1029 static void
1030 convert_real_slow (XImage *image, guchar *pixels, int rowstride, xlib_colormap *cmap, int alpha)
1031 {
1032         int xx, yy;
1033         int width, height;
1034         int bpl;
1035         guint8 *srow = image->data, *orow = pixels;
1036         guint8 *s;
1037         guint8 *o;
1038         guint32 pixel;
1039         Visual *v;
1040         guint8 component;
1041         int i;
1042         int red_shift, red_prec, green_shift, green_prec, blue_shift, blue_prec;
1043
1044         width = image->width;
1045         height = image->height;
1046         bpl = image->bytes_per_line;
1047         v = cmap->visual;
1048
1049         visual_decompose_mask (v->red_mask, &red_shift, &red_prec);
1050         visual_decompose_mask (v->green_mask, &green_shift, &green_prec);
1051         visual_decompose_mask (v->blue_mask, &blue_shift, &blue_prec);
1052
1053         for (yy = 0; yy < height; yy++) {
1054                 s = srow;
1055                 o = orow;
1056                 for (xx = 0; xx < width; xx++) {
1057                         pixel = XGetPixel (image, xx, yy);
1058                         switch (v->class) {
1059                                 /* I assume this is right for static & greyscale's too? */
1060                         case StaticGray:
1061                         case GrayScale:
1062                         case StaticColor:
1063                         case PseudoColor:
1064                                 *o++ = cmap->colors[pixel].red;
1065                                 *o++ = cmap->colors[pixel].green;
1066                                 *o++ = cmap->colors[pixel].blue;
1067                                 break;
1068                         case TrueColor:
1069                                 /* This is odd because it must sometimes shift left (otherwise
1070                                    I'd just shift >> (*_shift - 8 + *_prec + <0-7>). This logic
1071                                    should work for all bit sizes/shifts/etc. */
1072                                 component = 0;
1073                                 for (i = 24; i < 32; i += red_prec)
1074                                         component |= ((pixel & v->red_mask) << (32 - red_shift - red_prec)) >> i;
1075                                 *o++ = component;
1076                                 component = 0;
1077                                 for (i = 24; i < 32; i += green_prec)
1078                                         component |= ((pixel & v->green_mask) << (32 - green_shift - green_prec)) >> i;
1079                                 *o++ = component;
1080                                 component = 0;
1081                                 for (i = 24; i < 32; i += blue_prec)
1082                                         component |= ((pixel & v->blue_mask) << (32 - blue_shift - blue_prec)) >> i;
1083                                 *o++ = component;
1084                                 break;
1085                         case DirectColor:
1086                                 *o++ = cmap->colors[((pixel & v->red_mask) << (32 - red_shift - red_prec)) >> 24].red;
1087                                 *o++ = cmap->colors[((pixel & v->green_mask) << (32 - green_shift - green_prec)) >> 24].green;
1088                                 *o++ = cmap->colors[((pixel & v->blue_mask) << (32 - blue_shift - blue_prec)) >> 24].blue;
1089                                 break;
1090                         }
1091                         if (alpha)
1092                                 *o++ = 0xff;
1093                 }
1094                 srow += bpl;
1095                 orow += rowstride;
1096         }
1097 }
1098
1099 static xlib_colormap *
1100 xlib_get_colormap (Colormap id, Visual *visual, MagnifierData *mag_data)
1101 {
1102         int i;
1103         xlib_colormap *xc = g_new (xlib_colormap, 1);
1104
1105         xc->size = visual->map_entries;
1106         xc->colors = g_new (XColor, xc->size);
1107         xc->visual = visual;
1108         xc->colormap = id;
1109
1110         for (i = 0; i < xc->size; i++) {
1111                 xc->colors[i].pixel = i;
1112                 xc->colors[i].flags = DoRed | DoGreen | DoBlue;
1113         }
1114
1115         XQueryColors (mag_data->source_display, xc->colormap, xc->colors, xc->size);
1116
1117         return xc;
1118 }
1119
1120 typedef void (* cfunc) (XImage *image, guchar *pixels, int rowstride, xlib_colormap *cmap);
1121 static cfunc convert_map[] = {
1122         rgb1,rgb1,rgb1a,rgb1a,
1123         rgb8,rgb8,rgb8a,rgb8a,
1124         rgb555lsb,rgb555msb,rgb555alsb,rgb555amsb,
1125         rgb565lsb,rgb565msb,rgb565alsb,rgb565amsb,
1126         rgb888lsb,rgb888msb,rgb888alsb,rgb888amsb
1127 };
1128
1129 static void
1130 rgbconvert (XImage *image, guchar *pixels, int rowstride, int alpha, xlib_colormap *cmap,
1131             MagnifierData *mag_data)
1132 {
1133   int index = (image->byte_order == MSBFirst) | (alpha != 0) << 1;
1134   int bank=5;           /* default fallback converter */
1135   Visual *v = cmap->visual;
1136   if (mag_data->fast_rgb_convert)
1137     {
1138         switch (v->class) {
1139                                 /* I assume this is right for static & greyscale's too? */
1140         case StaticGray:
1141         case GrayScale:
1142         case StaticColor:
1143         case PseudoColor:
1144                 switch (image->bits_per_pixel) {
1145                 case 1:
1146                         bank = 0;
1147                         break;
1148                 case 8:
1149                         bank = 1;
1150                         break;
1151                 }
1152                 break;
1153         case TrueColor:
1154                 switch (image->depth) {
1155                 case 15:
1156                         if (v->red_mask == 0x7c00 && v->green_mask == 0x3e0 && v->blue_mask == 0x1f
1157                             && image->bits_per_pixel == 16)
1158                                 bank = 2;
1159                         break;
1160                 case 16:
1161                         if (v->red_mask == 0xf800 && v->green_mask == 0x7e0 && v->blue_mask == 0x1f
1162                             && image->bits_per_pixel == 16)
1163                                 bank = 3;
1164                         break;
1165                 case 24:
1166                 case 32:
1167                         if (v->red_mask == 0xff0000 && v->green_mask == 0xff00 && v->blue_mask == 0xff
1168                             && image->bits_per_pixel == 32)
1169                                 bank = 4;
1170                         break;
1171                 }
1172                 break;
1173         case DirectColor:
1174                 /* always use the slow version */
1175                 break;
1176         }
1177     }
1178
1179         if (bank==5) {
1180                 convert_real_slow(image, pixels, rowstride, cmap, alpha);
1181         } else {
1182                 index |= bank << 2;
1183                 (* convert_map[index]) (image, pixels, rowstride, cmap);
1184         }
1185 }
1186
1187 void get_root_image(Window src, GdkPixbuf *dest, int src_x, int src_y, MagnifierData *mag_data)  {
1188         XImage *image;
1189         int width = mag_data->mag_width/mag_data->factor_x;
1190         int height = mag_data->mag_height/mag_data->factor_y;
1191
1192         /* Get SpiImage in ZPixmap format (packed bits). */
1193         image = XGetImage (mag_data->source_display, src, src_x, src_y,
1194                            width, height, AllPlanes, ZPixmap);
1195         g_assert(image != NULL);
1196
1197         if(x_cmap == NULL){
1198             XWindowAttributes wa;
1199             XGetWindowAttributes (mag_data->source_display, src, &wa);
1200             x_cmap = xlib_get_colormap (wa.colormap, wa.visual, mag_data);
1201         }
1202         /* we offset into the image data based on the position we are retrieving from */
1203         rgbconvert (image, gdk_pixbuf_get_pixels(dest),
1204                     gdk_pixbuf_get_rowstride(dest),
1205                     gdk_pixbuf_get_has_alpha(dest),
1206                     x_cmap,
1207                     mag_data);
1208
1209         /* would like to use GDK routine, but since we don't have multi-head
1210            yet, we have to use X */
1211
1212         XDestroyImage (image);
1213 }
1214
1215