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