vpDisplayX.cpp

/****************************************************************************
 *
 * ViSP, open source Visual Servoing Platform software.
 * Copyright (C) 2005 - 2019 by Inria. All rights reserved.
 *
 * This software is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 * See the file LICENSE.txt at the root directory of this source
 * distribution for additional information about the GNU GPL.
 *
 * For using ViSP with software that can not be combined with the GNU
 * GPL, please contact Inria about acquiring a ViSP Professional
 * Edition License.
 *
 * See http://visp.inria.fr for more information.
 *
 * This software was developed at:
 * Inria Rennes - Bretagne Atlantique
 * Campus Universitaire de Beaulieu
 * 35042 Rennes Cedex
 * France
 *
 * If you have questions regarding the use of this file, please contact
 * Inria at visp@inria.fr
 *
 * This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
 * WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
 *
 * Description:
 * Image display.
 *
 * Authors:
 * Fabien Spindler
 * Anthony Saunier
 *
 *****************************************************************************/
 
#include <visp3/core/vpConfig.h>
#ifdef VISP_HAVE_X11
 
#include <cmath> // std::fabs
#include <iostream>
#include <limits> // numeric_limits
#include <stdio.h>
#include <stdlib.h>
 
// Display stuff
#include <visp3/core/vpDisplay.h>
#include <visp3/gui/vpDisplayX.h>
 
// debug / exception
#include <visp3/core/vpDebug.h>
#include <visp3/core/vpDisplayException.h>
 
// math
#include <visp3/core/vpMath.h>
 
#ifndef DOXYGEN_SHOULD_SKIP_THIS
 
#include <X11/Xlib.h>
#include <X11/Xutil.h>
 
// Work around to use this class with Eigen3
#ifdef Success
#undef Success // See http://eigen.tuxfamily.org/bz/show_bug.cgi?id=253
#endif
 
class vpDisplayX::Impl
{
public:
  Impl()
    : display(NULL), window(), Ximage(NULL), lut(), context(), screen(0), event(), pixmap(), x_color(NULL),
      screen_depth(8), xcolor(), values(), ximage_data_init(false), RMask(0), GMask(0), BMask(0), RShift(0), GShift(0),
      BShift(0)
  {
  }
 
  ~Impl() {}
 
  void clearDisplay(const vpColor &color, unsigned int width, unsigned int height)
  {
    if (color.id < vpColor::id_unknown)
      XSetWindowBackground(display, window, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
 
    XClearWindow(display, window);
 
    XFreePixmap(display, pixmap);
    // Pixmap creation.
    pixmap = XCreatePixmap(display, window, width, height, screen_depth);
  }
 
  void closeDisplay()
  {
    if (ximage_data_init == true)
      free(Ximage->data);
 
    Ximage->data = NULL;
    XDestroyImage(Ximage);
 
    XFreePixmap(display, pixmap);
 
    XFreeGC(display, context);
    XDestroyWindow(display, window);
    XCloseDisplay(display);
 
    if (x_color != NULL) {
      delete[] x_color;
      x_color = NULL;
    }
  }
 
  void displayCharString(const vpImagePoint &ip, const char *text, const vpColor &color, unsigned int scale)
  {
    if (color.id < vpColor::id_unknown)
      XSetForeground(display, context, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
    XDrawString(display, pixmap, context, (int)(ip.get_u() / scale), (int)(ip.get_v() / scale), text,
                (int)strlen(text));
  }
 
  void displayCircle(const vpImagePoint &center, unsigned int radius, const vpColor &color, bool fill,
                     unsigned int thickness, unsigned int scale)
  {
    if (color.id < vpColor::id_unknown)
      XSetForeground(display, context, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
 
    XSetLineAttributes(display, context, thickness, LineSolid, CapButt, JoinBevel);
 
    if (fill == false) {
      XDrawArc(display, pixmap, context, vpMath::round((center.get_u() - radius) / scale),
               vpMath::round((center.get_v() - radius) / scale), radius * 2 / scale, radius * 2 / scale, 0,
               23040); /* 23040 = 360*64 */
    } else {
      XFillArc(display, pixmap, context, vpMath::round((center.get_u() - radius) / scale),
               vpMath::round((center.get_v() - radius) / scale), radius * 2 / scale, radius * 2 / scale, 0,
               23040); /* 23040 = 360*64 */
    }
  }
 
  void displayDotLine(const vpImagePoint &ip1, const vpImagePoint &ip2, const vpColor &color, unsigned int thickness,
                      unsigned int scale)
  {
    if (color.id < vpColor::id_unknown)
      XSetForeground(display, context, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
 
    XSetLineAttributes(display, context, thickness, LineOnOffDash, CapButt, JoinBevel);
 
    XDrawLine(display, pixmap, context, vpMath::round(ip1.get_u() / scale), vpMath::round(ip1.get_v() / scale),
              vpMath::round(ip2.get_u() / scale), vpMath::round(ip2.get_v() / scale));
  }
 
  void displayImage(const vpImage<unsigned char> &I, unsigned int scale, unsigned int width, unsigned int height)
  {
    switch (screen_depth) {
    case 8: {
      // Correction de l'image de facon a liberer les niveaux de gris
      // ROUGE, VERT, BLEU, JAUNE
      unsigned char nivGrisMax = 255 - vpColor::id_unknown;
      if (scale == 1) {
        unsigned char *src_8 = (unsigned char *)I.bitmap;
        unsigned char *dst_8 = (unsigned char *)Ximage->data;
        unsigned int i = 0;
        unsigned int size = width * height;
 
        while (i < size) {
          unsigned char nivGris = src_8[i];
          if (nivGris > nivGrisMax)
            dst_8[i] = 255;
          else
            dst_8[i] = nivGris;
          i++;
        }
      } else {
        // Correction de l'image de facon a liberer les niveaux de gris
        // ROUGE, VERT, BLEU, JAUNE
        unsigned char *dst_8 = (unsigned char *)Ximage->data;
        unsigned int k = 0;
        for (unsigned int i = 0; i < height; i++) {
          for (unsigned int j = 0; j < width; j++) {
            unsigned char nivGris = I[i * scale][j * scale];
            if (nivGris > nivGrisMax)
              dst_8[k++] = 255;
            else
              dst_8[k++] = nivGris;
          }
        }
      }
 
      // Affichage de l'image dans la Pixmap.
      XPutImage(display, pixmap, context, Ximage, 0, 0, 0, 0, width, height);
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
    case 16: {
      unsigned int bytes_per_line = (unsigned int)Ximage->bytes_per_line;
      if (scale == 1) {
        for (unsigned int i = 0; i < height; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = 0; j < width; j++) {
            *(dst_16 + j) = (unsigned short)colortable[I[i][j]];
          }
        }
      } else {
        for (unsigned int i = 0; i < height; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = 0; j < width; j++) {
            *(dst_16 + j) = (unsigned short)colortable[I[i * scale][j * scale]];
          }
        }
      }
 
      // Affichage de l'image dans la Pixmap.
      XPutImage(display, pixmap, context, Ximage, 0, 0, 0, 0, width, height);
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
 
    case 24:
    default: {
      unsigned char *dst_32 = (unsigned char *)Ximage->data;
      if (scale == 1) {
        unsigned int size_ = width * height;
        unsigned char *bitmap = I.bitmap;
        unsigned char *n = I.bitmap + size_;
        // for (unsigned int i = 0; i < size; i++) // suppression de
        // l'iterateur i
        if (XImageByteOrder(display) == 1) {
          // big endian
          while (bitmap < n) {
            unsigned char val = *(bitmap++);
            *(dst_32++) = vpRGBa::alpha_default;
            *(dst_32++) = val; // Red
            *(dst_32++) = val; // Green
            *(dst_32++) = val; // Blue
          }
        } else {
          // little endian
          while (bitmap < n) {
            unsigned char val = *(bitmap++);
            *(dst_32++) = val; // Blue
            *(dst_32++) = val; // Green
            *(dst_32++) = val; // Red
            *(dst_32++) = vpRGBa::alpha_default;
          }
        }
      } else {
        if (XImageByteOrder(display) == 1) {
          // big endian
          for (unsigned int i = 0; i < height; i++) {
            for (unsigned int j = 0; j < width; j++) {
              unsigned char val = I[i * scale][j * scale];
              *(dst_32++) = vpRGBa::alpha_default;
              *(dst_32++) = val; // Red
              *(dst_32++) = val; // Green
              *(dst_32++) = val; // Blue
            }
          }
        } else {
          // little endian
          for (unsigned int i = 0; i < height; i++) {
            for (unsigned int j = 0; j < width; j++) {
              unsigned char val = I[i * scale][j * scale];
              *(dst_32++) = val; // Blue
              *(dst_32++) = val; // Green
              *(dst_32++) = val; // Red
              *(dst_32++) = vpRGBa::alpha_default;
            }
          }
        }
      }
 
      // Affichage de l'image dans la Pixmap.
      XPutImage(display, pixmap, context, Ximage, 0, 0, 0, 0, width, height);
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
    }
  }
 
  void displayImage(const vpImage<vpRGBa> &I, unsigned int scale, unsigned int width, unsigned int height)
  {
    switch (screen_depth) {
    case 16: {
      vpRGBa *bitmap = I.bitmap;
      unsigned int r, g, b;
      unsigned int bytes_per_line = (unsigned int)Ximage->bytes_per_line;
 
      if (scale == 1) {
        for (unsigned int i = 0; i < height; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = 0; j < width; j++) {
            r = bitmap->R;
            g = bitmap->G;
            b = bitmap->B;
            *(dst_16 + j) =
                (((r << 8) >> RShift) & RMask) | (((g << 8) >> GShift) & GMask) | (((b << 8) >> BShift) & BMask);
            bitmap++;
          }
        }
      } else {
        for (unsigned int i = 0; i < height; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = 0; j < width; j++) {
            vpRGBa val = I[i * scale][j * scale];
            r = val.R;
            g = val.G;
            b = val.B;
            *(dst_16 + j) =
                (((r << 8) >> RShift) & RMask) | (((g << 8) >> GShift) & GMask) | (((b << 8) >> BShift) & BMask);
            bitmap++;
          }
        }
      }
 
      XPutImage(display, pixmap, context, Ximage, 0, 0, 0, 0, width, height);
      XSetWindowBackgroundPixmap(display, window, pixmap);
 
      break;
    }
    case 24:
    case 32: {
      /*
       * 32-bit source, 24/32-bit destination
       */
      unsigned char *dst_32 = NULL;
      dst_32 = (unsigned char *)Ximage->data;
      if (scale == 1) {
        vpRGBa *bitmap = I.bitmap;
        unsigned int sizeI = width * height;
        if (XImageByteOrder(display) == 1) {
          // big endian
          for (unsigned int i = 0; i < sizeI; i++) {
            *(dst_32++) = bitmap->A;
            *(dst_32++) = bitmap->R;
            *(dst_32++) = bitmap->G;
            *(dst_32++) = bitmap->B;
            bitmap++;
          }
        } else {
          // little endian
          for (unsigned int i = 0; i < sizeI; i++) {
            *(dst_32++) = bitmap->B;
            *(dst_32++) = bitmap->G;
            *(dst_32++) = bitmap->R;
            *(dst_32++) = bitmap->A;
            bitmap++;
          }
        }
      } else {
        if (XImageByteOrder(display) == 1) {
          // big endian
          for (unsigned int i = 0; i < height; i++) {
            for (unsigned int j = 0; j < width; j++) {
              vpRGBa val = I[i * scale][j * scale];
              *(dst_32++) = val.A;
              *(dst_32++) = val.R;
              *(dst_32++) = val.G;
              *(dst_32++) = val.B;
            }
          }
        } else {
          // little endian
          for (unsigned int i = 0; i < height; i++) {
            for (unsigned int j = 0; j < width; j++) {
              vpRGBa val = I[i * scale][j * scale];
              *(dst_32++) = val.B;
              *(dst_32++) = val.G;
              *(dst_32++) = val.R;
              *(dst_32++) = val.A;
            }
          }
        }
      }
 
      // Affichage de l'image dans la Pixmap.
      XPutImage(display, pixmap, context, Ximage, 0, 0, 0, 0, width, height);
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
    default:
      throw(vpDisplayException(vpDisplayException::depthNotSupportedError,
                               "Unsupported depth (%d bpp) for color display", screen_depth));
    }
  }
 
  void displayImage(const unsigned char *bitmap, unsigned int width, unsigned int height)
  {
    unsigned char *dst_32 = (unsigned char *)Ximage->data;
    for (unsigned int i = 0; i < width * height; i++) {
      *(dst_32++) = *bitmap; // red component.
      *(dst_32++) = *bitmap; // green component.
      *(dst_32++) = *bitmap; // blue component.
      *(dst_32++) = *bitmap; // luminance component.
      bitmap++;
    }
 
    // Affichage de l'image dans la Pixmap.
    XPutImage(display, pixmap, context, Ximage, 0, 0, 0, 0, width, height);
    XSetWindowBackgroundPixmap(display, window, pixmap);
  }
 
  void displayImageROI(const vpImage<unsigned char> &I, const vpImagePoint &iP, unsigned int w, unsigned int h,
                       unsigned int scale, unsigned int width, unsigned int height)
  {
    switch (screen_depth) {
    case 8: {
      // Correction de l'image de facon a liberer les niveaux de gris
      // ROUGE, VERT, BLEU, JAUNE
      unsigned char nivGrisMax = 255 - vpColor::id_unknown;
      if (scale == 1) {
        unsigned char *src_8 = (unsigned char *)I.bitmap;
        unsigned char *dst_8 = (unsigned char *)Ximage->data;
        unsigned int iwidth = I.getWidth();
 
        src_8 = src_8 + (int)(iP.get_i() * iwidth + iP.get_j());
        dst_8 = dst_8 + (int)(iP.get_i() * width + iP.get_j());
 
        unsigned int i = 0;
        while (i < h) {
          unsigned int j = 0;
          while (j < w) {
            unsigned char nivGris = *(src_8 + j);
            if (nivGris > nivGrisMax)
              *(dst_8 + j) = 255;
            else
              *(dst_8 + j) = nivGris;
            j++;
          }
          src_8 = src_8 + iwidth;
          dst_8 = dst_8 + width;
          i++;
        }
 
        XPutImage(display, pixmap, context, Ximage, (int)iP.get_u(), (int)iP.get_v(), (int)iP.get_u(), (int)iP.get_v(),
                  w, h);
      } else {
        // Correction de l'image de facon a liberer les niveaux de gris
        // ROUGE, VERT, BLEU, JAUNE
        int i_min = (std::max)((int)ceil(iP.get_i() / scale), 0);
        int j_min = (std::max)((int)ceil(iP.get_j() / scale), 0);
        int i_max = (std::min)((int)ceil((iP.get_i() + h) / scale), (int)height);
        int j_max = (std::min)((int)ceil((iP.get_j() + w) / scale), (int)width);
 
        unsigned int i_min_ = (unsigned int)i_min;
        unsigned int i_max_ = (unsigned int)i_max;
        unsigned int j_min_ = (unsigned int)j_min;
        unsigned int j_max_ = (unsigned int)j_max;
 
        for (unsigned int i = i_min_; i < i_max_; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * width;
          for (unsigned int j = j_min_; j < j_max_; j++) {
            unsigned char nivGris = I[i * scale][j * scale];
            if (nivGris > nivGrisMax)
              dst_8[j] = 255;
            else
              dst_8[j] = nivGris;
          }
        }
        XPutImage(display, pixmap, context, Ximage, j_min, i_min, j_min, i_min, j_max_ - j_min_, i_max_ - i_min_);
      }
 
      // Affichage de l'image dans la Pixmap.
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
    case 16: {
      unsigned int bytes_per_line = (unsigned int)Ximage->bytes_per_line;
      if (scale == 1) {
        for (unsigned int i = (unsigned int)iP.get_i(); i < (unsigned int)(iP.get_i() + h); i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = (unsigned int)iP.get_j(); j < (unsigned int)(iP.get_j() + w); j++) {
            *(dst_16 + j) = (unsigned short)colortable[I[i][j]];
          }
        }
 
        XPutImage(display, pixmap, context, Ximage, (int)iP.get_u(), (int)iP.get_v(), (int)iP.get_u(), (int)iP.get_v(),
                  w, h);
      } else {
        int i_min = (std::max)((int)ceil(iP.get_i() / scale), 0);
        int j_min = (std::max)((int)ceil(iP.get_j() / scale), 0);
        int i_max = (std::min)((int)ceil((iP.get_i() + h) / scale), (int)height);
        int j_max = (std::min)((int)ceil((iP.get_j() + w) / scale), (int)width);
 
        unsigned int i_min_ = (unsigned int)i_min;
        unsigned int i_max_ = (unsigned int)i_max;
        unsigned int j_min_ = (unsigned int)j_min;
        unsigned int j_max_ = (unsigned int)j_max;
 
        for (unsigned int i = i_min_; i < i_max_; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = j_min_; j < j_max_; j++) {
            *(dst_16 + j) = (unsigned short)colortable[I[i * scale][j * scale]];
          }
        }
 
        XPutImage(display, pixmap, context, Ximage, j_min, i_min, j_min, i_min, j_max_ - j_min_, i_max_ - i_min_);
      }
 
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
 
    case 24:
    default: {
      if (scale == 1) {
        unsigned int iwidth = I.getWidth();
        unsigned char *src_8 = I.bitmap + (int)(iP.get_i() * iwidth + iP.get_j());
        unsigned char *dst_32 = (unsigned char *)Ximage->data + (int)(iP.get_i() * 4 * width + iP.get_j() * 4);
 
        if (XImageByteOrder(display) == 1) {
          // big endian
          unsigned int i = 0;
          while (i < h) {
            unsigned int j = 0;
            while (j < w) {
              unsigned char val = *(src_8 + j);
              *(dst_32 + 4 * j) = vpRGBa::alpha_default;
              *(dst_32 + 4 * j + 1) = val;
              *(dst_32 + 4 * j + 2) = val;
              *(dst_32 + 4 * j + 3) = val;
              j++;
            }
            src_8 = src_8 + iwidth;
            dst_32 = dst_32 + 4 * width;
            i++;
          }
        } else {
          // little endian
          unsigned int i = 0;
          while (i < h) {
            unsigned int j = 0;
            while (j < w) {
              unsigned char val = *(src_8 + j);
              *(dst_32 + 4 * j) = val;
              *(dst_32 + 4 * j + 1) = val;
              *(dst_32 + 4 * j + 2) = val;
              *(dst_32 + 4 * j + 3) = vpRGBa::alpha_default;
              j++;
            }
            src_8 = src_8 + iwidth;
            dst_32 = dst_32 + 4 * width;
            i++;
          }
        }
 
        XPutImage(display, pixmap, context, Ximage, (int)iP.get_u(), (int)iP.get_v(), (int)iP.get_u(), (int)iP.get_v(),
                  w, h);
      } else {
        int i_min = (std::max)((int)ceil(iP.get_i() / scale), 0);
        int j_min = (std::max)((int)ceil(iP.get_j() / scale), 0);
        int i_max = (std::min)((int)ceil((iP.get_i() + h) / scale), (int)height);
        int j_max = (std::min)((int)ceil((iP.get_j() + w) / scale), (int)width);
 
        unsigned int i_min_ = (unsigned int)i_min;
        unsigned int i_max_ = (unsigned int)i_max;
        unsigned int j_min_ = (unsigned int)j_min;
        unsigned int j_max_ = (unsigned int)j_max;
 
        if (XImageByteOrder(display) == 1) {
          // big endian
          for (unsigned int i = i_min_; i < i_max_; i++) {
            unsigned char *dst_32 = (unsigned char *)Ximage->data + (int)(i * 4 * width + j_min_ * 4);
            for (unsigned int j = j_min_; j < j_max_; j++) {
              unsigned char val = I[i * scale][j * scale];
              *(dst_32++) = vpRGBa::alpha_default;
              *(dst_32++) = val;
              *(dst_32++) = val;
              *(dst_32++) = val;
            }
          }
        } else {
          // little endian
          for (unsigned int i = i_min_; i < i_max_; i++) {
            unsigned char *dst_32 = (unsigned char *)Ximage->data + (int)(i * 4 * width + j_min_ * 4);
            for (unsigned int j = j_min_; j < j_max_; j++) {
              unsigned char val = I[i * scale][j * scale];
              *(dst_32++) = val;
              *(dst_32++) = val;
              *(dst_32++) = val;
              *(dst_32++) = vpRGBa::alpha_default;
            }
          }
        }
 
        XPutImage(display, pixmap, context, Ximage, j_min, i_min, j_min, i_min, j_max_ - j_min_, i_max_ - i_min_);
      }
 
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
    }
  }
 
  void displayImageROI(const vpImage<vpRGBa> &I, const vpImagePoint &iP, unsigned int w, unsigned int h,
                       unsigned int scale, unsigned int width, unsigned int height)
  {
    switch (screen_depth) {
    case 16: {
      if (scale == 1) {
        unsigned int bytes_per_line = (unsigned int)Ximage->bytes_per_line;
        for (unsigned int i = (unsigned int)iP.get_i(); i < (unsigned int)(iP.get_i() + h); i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = (unsigned int)iP.get_j(); j < (unsigned int)(iP.get_j() + w); j++) {
            vpRGBa val = I[i][j];
            unsigned int r = val.R;
            unsigned int g = val.G;
            unsigned int b = val.B;
            *(dst_16 + j) =
                (((r << 8) >> RShift) & RMask) | (((g << 8) >> GShift) & GMask) | (((b << 8) >> BShift) & BMask);
          }
        }
        XPutImage(display, pixmap, context, Ximage, (int)iP.get_u(), (int)iP.get_v(), (int)iP.get_u(), (int)iP.get_v(),
                  w, h);
      } else {
        unsigned int bytes_per_line = (unsigned int)Ximage->bytes_per_line;
        int i_min = (std::max)((int)ceil(iP.get_i() / scale), 0);
        int j_min = (std::max)((int)ceil(iP.get_j() / scale), 0);
        int i_max = (std::min)((int)ceil((iP.get_i() + h) / scale), (int)height);
        int j_max = (std::min)((int)ceil((iP.get_j() + w) / scale), (int)width);
 
        unsigned int i_min_ = (unsigned int)i_min;
        unsigned int i_max_ = (unsigned int)i_max;
        unsigned int j_min_ = (unsigned int)j_min;
        unsigned int j_max_ = (unsigned int)j_max;
 
        for (unsigned int i = i_min_; i < i_max_; i++) {
          unsigned char *dst_8 = (unsigned char *)Ximage->data + i * bytes_per_line;
          unsigned short *dst_16 = (unsigned short *)dst_8;
          for (unsigned int j = j_min_; j < j_max_; j++) {
            vpRGBa val = I[i * scale][j * scale];
            unsigned int r = val.R;
            unsigned int g = val.G;
            unsigned int b = val.B;
            *(dst_16 + j) =
                (((r << 8) >> RShift) & RMask) | (((g << 8) >> GShift) & GMask) | (((b << 8) >> BShift) & BMask);
          }
        }
        XPutImage(display, pixmap, context, Ximage, j_min, i_min, j_min, i_min, j_max_ - j_min_, i_max_ - i_min_);
      }
 
      XSetWindowBackgroundPixmap(display, window, pixmap);
 
      break;
    }
    case 24:
    case 32: {
      /*
       * 32-bit source, 24/32-bit destination
       */
 
      if (scale == 1) {
        unsigned char *dst_32 = (unsigned char *)Ximage->data;
        vpRGBa *src_32 = I.bitmap;
 
        unsigned int iwidth = I.getWidth();
 
        src_32 = src_32 + (int)(iP.get_i() * iwidth + iP.get_j());
        dst_32 = dst_32 + (int)(iP.get_i() * 4 * width + iP.get_j() * 4);
 
        unsigned int i = 0;
 
        if (XImageByteOrder(display) == 1) {
          // big endian
          while (i < h) {
            unsigned int j = 0;
            while (j < w) {
              *(dst_32 + 4 * j) = (src_32 + j)->A;
              *(dst_32 + 4 * j + 1) = (src_32 + j)->R;
              *(dst_32 + 4 * j + 2) = (src_32 + j)->G;
              *(dst_32 + 4 * j + 3) = (src_32 + j)->B;
 
              j++;
            }
            src_32 = src_32 + iwidth;
            dst_32 = dst_32 + 4 * width;
            i++;
          }
 
        } else {
          // little endian
          while (i < h) {
            unsigned int j = 0;
            while (j < w) {
              *(dst_32 + 4 * j) = (src_32 + j)->B;
              *(dst_32 + 4 * j + 1) = (src_32 + j)->G;
              *(dst_32 + 4 * j + 2) = (src_32 + j)->R;
              *(dst_32 + 4 * j + 3) = (src_32 + j)->A;
 
              j++;
            }
            src_32 = src_32 + iwidth;
            dst_32 = dst_32 + 4 * width;
            i++;
          }
        }
 
        XPutImage(display, pixmap, context, Ximage, (int)iP.get_u(), (int)iP.get_v(), (int)iP.get_u(), (int)iP.get_v(),
                  w, h);
      } else {
        int i_min = (std::max)((int)ceil(iP.get_i() / scale), 0);
        int j_min = (std::max)((int)ceil(iP.get_j() / scale), 0);
        int i_max = (std::min)((int)ceil((iP.get_i() + h) / scale), (int)height);
        int j_max = (std::min)((int)ceil((iP.get_j() + w) / scale), (int)width);
 
        unsigned int i_min_ = (unsigned int)i_min;
        unsigned int i_max_ = (unsigned int)i_max;
        unsigned int j_min_ = (unsigned int)j_min;
        unsigned int j_max_ = (unsigned int)j_max;
 
        if (XImageByteOrder(display) == 1) {
          // big endian
          for (unsigned int i = i_min_; i < i_max_; i++) {
            unsigned char *dst_32 = (unsigned char *)Ximage->data + (int)(i * 4 * width + j_min_ * 4);
            for (unsigned int j = j_min_; j < j_max_; j++) {
              vpRGBa val = I[i * scale][j * scale];
              *(dst_32++) = val.A;
              *(dst_32++) = val.R;
              *(dst_32++) = val.G;
              *(dst_32++) = val.B;
            }
          }
        } else {
          // little endian
          for (unsigned int i = i_min_; i < i_max_; i++) {
            unsigned char *dst_32 = (unsigned char *)Ximage->data + (int)(i * 4 * width + j_min_ * 4);
            for (unsigned int j = j_min_; j < j_max_; j++) {
              vpRGBa val = I[i * scale][j * scale];
              *(dst_32++) = val.B;
              *(dst_32++) = val.G;
              *(dst_32++) = val.R;
              *(dst_32++) = val.A;
            }
          }
        }
        XPutImage(display, pixmap, context, Ximage, j_min, i_min, j_min, i_min, j_max_ - j_min_, i_max_ - i_min_);
      }
 
      XSetWindowBackgroundPixmap(display, window, pixmap);
      break;
    }
    default:
      throw(vpDisplayException(vpDisplayException::depthNotSupportedError,
                               "Unsupported depth (%d bpp) for color display", screen_depth));
    }
  }
 
  void displayLine(const vpImagePoint &ip1, const vpImagePoint &ip2, const vpColor &color, unsigned int thickness,
                   unsigned int scale)
  {
    if (color.id < vpColor::id_unknown)
      XSetForeground(display, context, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
 
    XSetLineAttributes(display, context, thickness, LineSolid, CapButt, JoinBevel);
 
    XDrawLine(display, pixmap, context, vpMath::round(ip1.get_u() / scale), vpMath::round(ip1.get_v() / scale),
              vpMath::round(ip2.get_u() / scale), vpMath::round(ip2.get_v() / scale));
  }
 
  void displayPoint(const vpImagePoint &ip, const vpColor &color, unsigned int thickness, unsigned int scale)
  {
    if (color.id < vpColor::id_unknown)
      XSetForeground(display, context, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
 
    if (thickness == 1) {
      XDrawPoint(display, pixmap, context, vpMath::round(ip.get_u() / scale), vpMath::round(ip.get_v() / scale));
    } else {
      XFillRectangle(display, pixmap, context, vpMath::round(ip.get_u() / scale), vpMath::round(ip.get_v() / scale),
                     thickness, thickness);
    }
  }
 
  void displayRectangle(const vpImagePoint &topLeft, unsigned int w, unsigned int h, const vpColor &color, bool fill,
                        unsigned int thickness, unsigned int scale)
  {
    if (color.id < vpColor::id_unknown)
      XSetForeground(display, context, x_color[color.id]);
    else {
      xcolor.pad = 0;
      xcolor.red = 256 * color.R;
      xcolor.green = 256 * color.G;
      xcolor.blue = 256 * color.B;
      XAllocColor(display, lut, &xcolor);
      XSetForeground(display, context, xcolor.pixel);
    }
    XSetLineAttributes(display, context, thickness, LineSolid, CapButt, JoinBevel);
    if (fill == false) {
      XDrawRectangle(display, pixmap, context, vpMath::round(topLeft.get_u() / scale),
                     vpMath::round(topLeft.get_v() / scale), w / scale, h / scale);
    } else {
      XFillRectangle(display, pixmap, context, vpMath::round(topLeft.get_u() / scale),
                     vpMath::round(topLeft.get_v() / scale), w / scale, h / scale);
    }
  }
 
  void flushDisplay()
  {
    XClearWindow(display, window);
    XFlush(display);
  }
 
  void flushDisplayROI(const vpImagePoint &iP, unsigned int w, unsigned int h, unsigned int scale)
  {
    XClearArea(display, window, (int)(iP.get_u() / scale), (int)(iP.get_v() / scale), w / scale, h / scale, 0);
    XFlush(display);
  }
 
  bool getClick(vpImagePoint &ip, vpMouseButton::vpMouseButtonType &button, bool blocking, unsigned int scale)
  {
    bool ret = false;
    Window rootwin, childwin;
    int root_x, root_y, win_x, win_y;
    unsigned int modifier;
 
    // Event testing
    if (blocking) {
      XCheckMaskEvent(display, ButtonPressMask, &event);
      XCheckMaskEvent(display, ButtonReleaseMask, &event);
      XMaskEvent(display, ButtonPressMask, &event);
      ret = true;
    } else {
      ret = XCheckMaskEvent(display, ButtonPressMask, &event);
    }
 
    if (ret) {
      // Get mouse position
      if (XQueryPointer(display, window, &rootwin, &childwin, &root_x, &root_y, &win_x, &win_y, &modifier)) {
        ip.set_u((double)event.xbutton.x * scale);
        ip.set_v((double)event.xbutton.y * scale);
        switch (event.xbutton.button) {
        case Button1:
          button = vpMouseButton::button1;
          break;
        case Button2:
          button = vpMouseButton::button2;
          break;
        case Button3:
          button = vpMouseButton::button3;
          break;
        }
      }
    }
 
    return ret;
  }
 
  bool getClickUp(vpImagePoint &ip, vpMouseButton::vpMouseButtonType &button, bool blocking, unsigned int scale)
  {
    bool ret = false;
    Window rootwin, childwin;
    int root_x, root_y, win_x, win_y;
    unsigned int modifier;
 
    // Event testing
    if (blocking) {
      XCheckMaskEvent(display, ButtonPressMask, &event);
      XCheckMaskEvent(display, ButtonReleaseMask, &event);
      XMaskEvent(display, ButtonReleaseMask, &event);
      ret = true;
    } else {
      ret = XCheckMaskEvent(display, ButtonReleaseMask, &event);
    }
 
    if (ret) {
      /* Recuperation de la coordonnee du pixel clique. */
      if (XQueryPointer(display, window, &rootwin, &childwin, &root_x, &root_y, &win_x, &win_y, &modifier)) {
        ip.set_u((double)event.xbutton.x * scale);
        ip.set_v((double)event.xbutton.y * scale);
        switch (event.xbutton.button) {
        case Button1:
          button = vpMouseButton::button1;
          break;
        case Button2:
          button = vpMouseButton::button2;
          break;
        case Button3:
          button = vpMouseButton::button3;
          break;
        }
      }
    }
 
    return ret;
  }
 
  void getImage(vpImage<vpRGBa> &I, unsigned int width, unsigned int height)
  {
    XImage *xi;
 
    XCopyArea(display, window, pixmap, context, 0, 0, width, height, 0, 0);
 
    xi = XGetImage(display, pixmap, 0, 0, width, height, AllPlanes, ZPixmap);
 
    I.resize(height, width);
 
    unsigned char *src_32 = NULL;
    src_32 = (unsigned char *)xi->data;
 
    if (screen_depth == 16) {
      for (unsigned int i = 0; i < I.getHeight(); i++) {
        size_t i_ = i * width;
        for (unsigned int j = 0; j < height; j++) {
          size_t ij_ = i_ + j;
          unsigned long pixel = XGetPixel(xi, (int)j, (int)i);
          I.bitmap[ij_].R = (((pixel & RMask) << RShift) >> 8);
          I.bitmap[ij_].G = (((pixel & GMask) << GShift) >> 8);
          I.bitmap[ij_].B = (((pixel & BMask) << BShift) >> 8);
          // On OSX the bottom/right corner (around the resizing icon) has
          // alpha component with different values than 255. That's why we
          // force alpha to vpRGBa::alpha_default
          I.bitmap[ij_].A = vpRGBa::alpha_default;
        }
      }
 
    } else {
      if (XImageByteOrder(display) == 1) {
        // big endian
        for (unsigned int i = 0; i < width * height; i++) {
          // On OSX the bottom/right corner (around the resizing icon) has
          // alpha component with different values than 255. That's why we
          // force alpha to vpRGBa::alpha_default
          I.bitmap[i].A = vpRGBa::alpha_default; // src_32[i*4] ;
          I.bitmap[i].R = src_32[i * 4 + 1];
          I.bitmap[i].G = src_32[i * 4 + 2];
          I.bitmap[i].B = src_32[i * 4 + 3];
        }
      } else {
        // little endian
        for (unsigned int i = 0; i < width * height; i++) {
          I.bitmap[i].B = src_32[i * 4];
          I.bitmap[i].G = src_32[i * 4 + 1];
          I.bitmap[i].R = src_32[i * 4 + 2];
          // On OSX the bottom/right corner (around the resizing icon) has
          // alpha component with different values than 255. That's why we
          // force alpha to vpRGBa::alpha_default
          I.bitmap[i].A = vpRGBa::alpha_default; // src_32[i*4 + 3];
        }
      }
    }
    XDestroyImage(xi);
  }
 
  bool getKeyboardEvent(bool blocking)
  {
    bool ret = false;
 
    // Event testing
    if (blocking) {
      XMaskEvent(display, KeyPressMask, &event);
      ret = true;
    } else {
      ret = XCheckMaskEvent(display, KeyPressMask, &event);
    }
 
    return ret;
  }
 
  bool getKeyboardEvent(std::string &key, bool blocking)
  {
    bool ret = false;
    KeySym keysym;
    //   int     count;
    XComposeStatus compose_status;
    char buffer;
 
    // Event testing
    if (blocking) {
      XMaskEvent(display, KeyPressMask, &event);
      /* count = */ XLookupString((XKeyEvent *)&event, &buffer, 1, &keysym, &compose_status);
      key = buffer;
      ret = true;
    } else {
      ret = XCheckMaskEvent(display, KeyPressMask, &event);
      if (ret) {
        /* count = */ XLookupString((XKeyEvent *)&event, &buffer, 1, &keysym, &compose_status);
        key = buffer;
      }
    }
 
    return ret;
  }
 
  int getMsb(unsigned int u32val)
  {
    int i;
 
    for (i = 31; i >= 0; --i) {
      if (u32val & 0x80000000L)
        break;
      u32val <<= 1;
    }
    return i;
  }
 
  bool getPointerMotionEvent(vpImagePoint &ip, unsigned int scale)
  {
    bool ret = false;
 
    Window rootwin, childwin;
    int root_x, root_y, win_x, win_y;
    unsigned int modifier;
    // Event testing
    ret = XCheckMaskEvent(display, PointerMotionMask, &event);
 
    if (ret) {
      // Get mouse position
      if (XQueryPointer(display, window, &rootwin, &childwin, &root_x, &root_y, &win_x, &win_y, &modifier)) {
        ip.set_u((double)event.xbutton.x * scale);
        ip.set_v((double)event.xbutton.y * scale);
      }
    }
 
    return ret;
  }
 
  bool getPointerPosition(vpImagePoint &ip, unsigned int scale)
  {
    bool ret = false;
    Window rootwin, childwin;
    int root_x, root_y, win_x, win_y;
    unsigned int modifier;
    // Event testing
    ret = true;
 
    if (ret) {
      // Get mouse position
      if (XQueryPointer(display, window, &rootwin, &childwin, &root_x, &root_y, &win_x, &win_y, &modifier)) {
        ip.set_u((double)win_x * scale);
        ip.set_v((double)win_y * scale);
      }
    }
 
    return ret;
  }
 
  unsigned int getScreenDepth()
  {
    Display *display_;
    int screen_;
    unsigned int depth;
 
    if ((display_ = XOpenDisplay(NULL)) == NULL) {
      throw(vpDisplayException(vpDisplayException::connexionError, "Can't connect display on server %s.",
                               XDisplayName(NULL)));
    }
    screen_ = DefaultScreen(display_);
    depth = (unsigned int)DefaultDepth(display_, screen_);
 
    XCloseDisplay(display_);
 
    return (depth);
  }
 
  void getScreenSize(unsigned int &w, unsigned int &h)
  {
    Display *display_;
    int screen_;
 
    if ((display_ = XOpenDisplay(NULL)) == NULL) {
      throw(vpDisplayException(vpDisplayException::connexionError, "Can't connect display on server %s.",
                               XDisplayName(NULL)));
    }
    screen_ = DefaultScreen(display_);
    w = (unsigned int)DisplayWidth(display_, screen_);
    h = (unsigned int)DisplayHeight(display_, screen_);
 
    XCloseDisplay(display_);
  }
 
  void init(unsigned int win_width, unsigned int win_height, int win_x, int win_y, const std::string &win_title)
  {
    if (x_color == NULL) {
      // id_unknown = number of predefined colors
      x_color = new unsigned long[vpColor::id_unknown];
    }
    // setup X11
    XSizeHints hints;
 
    // Positionnement de la fenetre dans l'ecran.
    if ((win_x < 0) || (win_y < 0)) {
      hints.flags = 0;
    } else {
      hints.flags = USPosition;
      hints.x = win_x;
      hints.y = win_y;
    }
 
    if ((display = XOpenDisplay(NULL)) == NULL) {
      vpERROR_TRACE("Can't connect display on server %s.\n", XDisplayName(NULL));
      throw(vpDisplayException(vpDisplayException::connexionError, "Can't connect display on server."));
    }
 
    screen = DefaultScreen(display);
    lut = DefaultColormap(display, screen);
    screen_depth = (unsigned int)DefaultDepth(display, screen);
 
    vpTRACE("Screen depth: %d\n", screen_depth);
 
    if ((window = XCreateSimpleWindow(display, RootWindow(display, screen), win_x, win_y, win_width, win_height, 1,
                                      BlackPixel(display, screen), WhitePixel(display, screen))) == 0) {
      vpERROR_TRACE("Can't create window.");
      throw(vpDisplayException(vpDisplayException::cannotOpenWindowError, "Can't create window."));
    }
 
    //
    // Create color table for 8 and 16 bits screen
    //
    if (screen_depth == 8) {
      lut = XCreateColormap(display, window, DefaultVisual(display, screen), AllocAll);
      xcolor.flags = DoRed | DoGreen | DoBlue;
 
      for (unsigned int i = 0; i < 256; i++) {
        xcolor.pixel = i;
        xcolor.red = 256 * i;
        xcolor.green = 256 * i;
        xcolor.blue = 256 * i;
        XStoreColor(display, lut, &xcolor);
      }
 
      XSetWindowColormap(display, window, lut);
      XInstallColormap(display, lut);
    }
 
    else if (screen_depth == 16) {
      for (unsigned int i = 0; i < 256; i++) {
        xcolor.pad = 0;
        xcolor.red = xcolor.green = xcolor.blue = 256 * i;
        if (XAllocColor(display, lut, &xcolor) == 0) {
          vpERROR_TRACE("Can't allocate 256 colors. Only %d allocated.", i);
          throw(vpDisplayException(vpDisplayException::colorAllocError, "Can't allocate 256 colors."));
        }
        colortable[i] = xcolor.pixel;
      }
 
      XSetWindowColormap(display, window, lut);
      XInstallColormap(display, lut);
 
      Visual *visual = DefaultVisual(display, screen);
      RMask = visual->red_mask;
      GMask = visual->green_mask;
      BMask = visual->blue_mask;
 
      RShift = 15 - getMsb(RMask); /* these are right-shifts */
      GShift = 15 - getMsb(GMask);
      BShift = 15 - getMsb(BMask);
    }
 
    vpColor pcolor; // predefined colors
 
    //
    // Create colors for overlay
    //
    switch (screen_depth) {
 
    case 8:
      // Color BLACK: default set to 0
 
      // Color WHITE: default set to 255
 
      // Color LIGHT GRAY.
      x_color[vpColor::id_lightGray] = 254;
      xcolor.pixel = x_color[vpColor::id_lightGray];
      xcolor.red = 256 * 192;
      xcolor.green = 256 * 192;
      xcolor.blue = 256 * 192;
      XStoreColor(display, lut, &xcolor);
 
      // Color GRAY.
      x_color[vpColor::id_gray] = 253;
      xcolor.pixel = x_color[vpColor::id_gray];
      xcolor.red = 256 * 128;
      xcolor.green = 256 * 128;
      xcolor.blue = 256 * 128;
      XStoreColor(display, lut, &xcolor);
 
      // Color DARK GRAY.
      x_color[vpColor::id_darkGray] = 252;
      xcolor.pixel = x_color[vpColor::id_darkGray];
      xcolor.red = 256 * 64;
      xcolor.green = 256 * 64;
      xcolor.blue = 256 * 64;
      XStoreColor(display, lut, &xcolor);
 
      // Color LIGHT RED.
      x_color[vpColor::id_lightRed] = 251;
      xcolor.pixel = x_color[vpColor::id_lightRed];
      xcolor.red = 256 * 255;
      xcolor.green = 256 * 140;
      xcolor.blue = 256 * 140;
      XStoreColor(display, lut, &xcolor);
 
      // Color RED.
      x_color[vpColor::id_red] = 250;
      xcolor.pixel = x_color[vpColor::id_red];
      xcolor.red = 256 * 255;
      xcolor.green = 0;
      xcolor.blue = 0;
      XStoreColor(display, lut, &xcolor);
 
      // Color DARK RED.
      x_color[vpColor::id_darkRed] = 249;
      xcolor.pixel = x_color[vpColor::id_darkRed];
      xcolor.red = 256 * 128;
      xcolor.green = 0;
      xcolor.blue = 0;
      XStoreColor(display, lut, &xcolor);
 
      // Color LIGHT GREEN.
      x_color[vpColor::id_lightGreen] = 248;
      xcolor.pixel = x_color[vpColor::id_lightGreen];
      xcolor.red = 256 * 140;
      xcolor.green = 256 * 255;
      xcolor.blue = 256 * 140;
      XStoreColor(display, lut, &xcolor);
 
      // Color GREEN.
      x_color[vpColor::id_green] = 247;
      xcolor.pixel = x_color[vpColor::id_green];
      xcolor.red = 0;
      xcolor.green = 256 * 255;
      xcolor.blue = 0;
      XStoreColor(display, lut, &xcolor);
 
      // Color DARK GREEN.
      x_color[vpColor::id_darkGreen] = 246;
      xcolor.pixel = x_color[vpColor::id_darkGreen];
      xcolor.red = 0;
      xcolor.green = 256 * 128;
      xcolor.blue = 0;
      XStoreColor(display, lut, &xcolor);
 
      // Color LIGHT BLUE.
      x_color[vpColor::id_lightBlue] = 245;
      xcolor.pixel = x_color[vpColor::id_lightBlue];
      xcolor.red = 256 * 140;
      xcolor.green = 256 * 140;
      xcolor.blue = 256 * 255;
      XStoreColor(display, lut, &xcolor);
 
      // Color BLUE.
      x_color[vpColor::id_blue] = 244;
      xcolor.pixel = x_color[vpColor::id_blue];
      xcolor.red = 0;
      xcolor.green = 0;
      xcolor.blue = 256 * 255;
      XStoreColor(display, lut, &xcolor);
 
      // Color DARK BLUE.
      x_color[vpColor::id_darkBlue] = 243;
      xcolor.pixel = x_color[vpColor::id_darkBlue];
      xcolor.red = 0;
      xcolor.green = 0;
      xcolor.blue = 256 * 128;
      XStoreColor(display, lut, &xcolor);
 
      // Color YELLOW.
      x_color[vpColor::id_yellow] = 242;
      xcolor.pixel = x_color[vpColor::id_yellow];
      xcolor.red = 256 * 255;
      xcolor.green = 256 * 255;
      xcolor.blue = 0;
      XStoreColor(display, lut, &xcolor);
 
      // Color ORANGE.
      x_color[vpColor::id_orange] = 241;
      xcolor.pixel = x_color[vpColor::id_orange];
      xcolor.red = 256 * 255;
      xcolor.green = 256 * 165;
      xcolor.blue = 0;
      XStoreColor(display, lut, &xcolor);
 
      // Color CYAN.
      x_color[vpColor::id_cyan] = 240;
      xcolor.pixel = x_color[vpColor::id_cyan];
      xcolor.red = 0;
      xcolor.green = 256 * 255;
      xcolor.blue = 256 * 255;
      XStoreColor(display, lut, &xcolor);
 
      // Color PURPLE.
      x_color[vpColor::id_purple] = 239;
      xcolor.pixel = x_color[vpColor::id_purple];
      xcolor.red = 256 * 128;
      xcolor.green = 0;
      xcolor.blue = 256 * 128;
      XStoreColor(display, lut, &xcolor);
 
      break;
 
    case 16:
    case 24:
    case 32: {
      xcolor.flags = DoRed | DoGreen | DoBlue;
 
      // Couleur BLACK.
      pcolor = vpColor::black;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_black] = xcolor.pixel;
 
      // Color WHITE.
      pcolor = vpColor::white;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_white] = xcolor.pixel;
 
      // Color LIGHT GRAY.
      pcolor = vpColor::lightGray;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_lightGray] = xcolor.pixel;
 
      // Color GRAY.
      pcolor = vpColor::gray;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_gray] = xcolor.pixel;
 
      // Color DARK GRAY.
      pcolor = vpColor::darkGray;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_darkGray] = xcolor.pixel;
 
      // Color LIGHT RED.
      pcolor = vpColor::lightRed;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_lightRed] = xcolor.pixel;
 
      // Color RED.
      pcolor = vpColor::red;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_red] = xcolor.pixel;
 
      // Color DARK RED.
      pcolor = vpColor::darkRed;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_darkRed] = xcolor.pixel;
 
      // Color LIGHT GREEN.
      pcolor = vpColor::lightGreen;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_lightGreen] = xcolor.pixel;
 
      // Color GREEN.
      pcolor = vpColor::green;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_green] = xcolor.pixel;
 
      // Color DARK GREEN.
      pcolor = vpColor::darkGreen;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_darkGreen] = xcolor.pixel;
 
      // Color LIGHT BLUE.
      pcolor = vpColor::lightBlue;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_lightBlue] = xcolor.pixel;
 
      // Color BLUE.
      pcolor = vpColor::blue;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_blue] = xcolor.pixel;
 
      // Color DARK BLUE.
      pcolor = vpColor::darkBlue;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_darkBlue] = xcolor.pixel;
 
      // Color YELLOW.
      pcolor = vpColor::yellow;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_yellow] = xcolor.pixel;
 
      // Color ORANGE.
      pcolor = vpColor::orange;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_orange] = xcolor.pixel;
 
      // Color CYAN.
      pcolor = vpColor::cyan;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_cyan] = xcolor.pixel;
 
      // Color PURPLE.
      pcolor = vpColor::purple;
      xcolor.pad = 0;
      xcolor.red = 256 * pcolor.R;
      xcolor.green = 256 * pcolor.G;
      xcolor.blue = 256 * pcolor.B;
      XAllocColor(display, lut, &xcolor);
      x_color[vpColor::id_purple] = xcolor.pixel;
      break;
    }
    }
 
    XSetStandardProperties(display, window, win_title.c_str(), win_title.c_str(), None, 0, 0, &hints);
    XMapWindow(display, window);
    // Selection des evenements.
    XSelectInput(display, window,
                 ExposureMask | ButtonPressMask | ButtonReleaseMask | KeyPressMask | KeyReleaseMask |
                     StructureNotifyMask | PointerMotionMask);
 
    /* Creation du contexte graphique */
    values.plane_mask = AllPlanes;
    values.fill_style = FillSolid;
    values.foreground = WhitePixel(display, screen);
    values.background = BlackPixel(display, screen);
    context = XCreateGC(display, window, GCPlaneMask | GCFillStyle | GCForeground | GCBackground, &values);
 
    if (context == NULL) {
      vpERROR_TRACE("Can't create graphics context.");
      throw(vpDisplayException(vpDisplayException::XWindowsError, "Can't create graphics context"));
    }
 
    // Pixmap creation.
    pixmap = XCreatePixmap(display, window, win_width, win_height, screen_depth);
 
    // Hangs when forward X11 is used to send the display to an other computer
    //  do
    //    XNextEvent ( display, &event );
    //  while ( event.xany.type != Expose );
 
    {
      Ximage = XCreateImage(display, DefaultVisual(display, screen), screen_depth, ZPixmap, 0, NULL, win_width,
                            win_height, XBitmapPad(display), 0);
 
      Ximage->data = (char *)malloc(win_height * (unsigned int)Ximage->bytes_per_line);
      ximage_data_init = true;
    }
 
    XSync(display, true);
 
    XStoreName(display, window, win_title.c_str());
  }
 
  void setFont(const std::string &fontname)
  {
    try {
      Font stringfont;
      stringfont = XLoadFont(display, fontname.c_str()); //"-adobe-times-bold-r-normal--18*");
      XSetFont(display, context, stringfont);
    } catch (...) {
      throw(vpDisplayException(vpDisplayException::notInitializedError, "Bad font"));
    }
  }
 
  void setTitle(const std::string &title) { XStoreName(display, window, title.c_str()); }
 
  void setWindowPosition(int win_x, int win_y) { XMoveWindow(display, window, win_x, win_y); }
 
private:
  Display *display;
  Window window;
  XImage *Ximage;
  Colormap lut;
  GC context;
  int screen;
  XEvent event;
  Pixmap pixmap;
  unsigned long *x_color; // Array of predefined colors
  unsigned int screen_depth;
  unsigned short colortable[256];
  XColor xcolor;
  XGCValues values;
  bool ximage_data_init;
  unsigned int RMask, GMask, BMask;
  int RShift, GShift, BShift;
};
#endif // #ifndef DOXYGEN_SHOULD_SKIP_THIS
 
vpDisplayX::vpDisplayX(vpImage<unsigned char> &I, vpScaleType scaleType) : vpDisplay(), m_impl(new Impl())
{
  setScale(scaleType, I.getWidth(), I.getHeight());
 
  init(I);
}
 
vpDisplayX::vpDisplayX(vpImage<unsigned char> &I, int x, int y, const std::string &title, vpScaleType scaleType)
  : vpDisplay(), m_impl(new Impl())
{
  setScale(scaleType, I.getWidth(), I.getHeight());
  init(I, x, y, title);
}
 
vpDisplayX::vpDisplayX(vpImage<vpRGBa> &I, vpScaleType scaleType) : vpDisplay(), m_impl(new Impl())
{
  setScale(scaleType, I.getWidth(), I.getHeight());
  init(I);
}
 
vpDisplayX::vpDisplayX(vpImage<vpRGBa> &I, int x, int y, const std::string &title, vpScaleType scaleType)
  : vpDisplay(), m_impl(new Impl())
{
  setScale(scaleType, I.getWidth(), I.getHeight());
  init(I, x, y, title);
}
 
vpDisplayX::vpDisplayX(int x, int y, const std::string &title) : vpDisplay(), m_impl(new Impl())
{
  m_windowXPosition = x;
  m_windowYPosition = y;
 
  m_title = title;
}
 
vpDisplayX::vpDisplayX() : vpDisplay(), m_impl(new Impl()) {}
 
vpDisplayX::~vpDisplayX()
{
  closeDisplay();
  delete m_impl;
}
 
void vpDisplayX::init(vpImage<unsigned char> &I, int win_x, int win_y, const std::string &win_title)
{
  if ((I.getHeight() == 0) || (I.getWidth() == 0)) {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "Image not initialized"));
  }
 
  if (win_x != -1)
    m_windowXPosition = win_x;
  if (win_y != -1)
    m_windowYPosition = win_y;
 
  if (!win_title.empty())
    m_title = win_title;
 
  setScale(m_scaleType, I.getWidth(), I.getHeight());
  init(I.getWidth(), I.getHeight(), m_windowXPosition, m_windowYPosition, m_title);
 
  I.display = this;
  m_displayHasBeenInitialized = true;
}
 
void vpDisplayX::init(vpImage<vpRGBa> &I, int win_x, int win_y, const std::string &win_title)
{
  if ((I.getHeight() == 0) || (I.getWidth() == 0)) {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "Image not initialized"));
  }
 
  if (win_x != -1)
    m_windowXPosition = win_x;
  if (win_y != -1)
    m_windowYPosition = win_y;
 
  if (!win_title.empty())
    m_title = win_title;
 
  setScale(m_scaleType, I.getWidth(), I.getHeight());
  init(I.getWidth(), I.getHeight(), m_windowXPosition, m_windowYPosition, m_title);
 
  I.display = this;
  m_displayHasBeenInitialized = true;
}
 
void vpDisplayX::init(unsigned int win_width, unsigned int win_height, int win_x, int win_y,
                      const std::string &win_title)
{
  setScale(m_scaleType, win_width, win_height);
 
  m_width = win_width / m_scale;
  m_height = win_height / m_scale;
 
  if (win_x != -1)
    m_windowXPosition = win_x;
  if (win_y != -1)
    m_windowYPosition = win_y;
 
  m_title = win_title;
 
  m_impl->init(m_width, m_height, m_windowXPosition, m_windowYPosition, m_title);
 
  m_displayHasBeenInitialized = true;
}
 
void vpDisplayX::setFont(const std::string &fontname)
{
  if (m_displayHasBeenInitialized) {
    if (!fontname.empty()) {
      m_impl->setFont(fontname);
    }
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::setTitle(const std::string &title)
{
  if (m_displayHasBeenInitialized) {
    m_title = title;
    if (!title.empty())
      m_impl->setTitle(title);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::setWindowPosition(int win_x, int win_y)
{
  if (m_displayHasBeenInitialized) {
    m_impl->setWindowPosition(win_x, win_y);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayImage(const vpImage<unsigned char> &I)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayImage(I, m_scale, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayImage(const vpImage<vpRGBa> &I)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayImage(I, m_scale, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayImage(const unsigned char *bitmap)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayImage(bitmap, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayImageROI(const vpImage<unsigned char> &I, const vpImagePoint &iP, unsigned int w,
                                 unsigned int h)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayImageROI(I, iP, w, h, m_scale, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayImageROI(const vpImage<vpRGBa> &I, const vpImagePoint &iP, unsigned int w, unsigned int h)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayImageROI(I, iP, w, h, m_scale, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::closeDisplay()
{
  if (m_displayHasBeenInitialized) {
    m_impl->closeDisplay();
 
    m_displayHasBeenInitialized = false;
  }
}
 
void vpDisplayX::flushDisplay()
{
  if (m_displayHasBeenInitialized) {
    m_impl->flushDisplay();
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::flushDisplayROI(const vpImagePoint &iP, unsigned int w, unsigned int h)
{
  if (m_displayHasBeenInitialized) {
    m_impl->flushDisplayROI(iP, w, h, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::clearDisplay(const vpColor &color)
{
  if (m_displayHasBeenInitialized) {
    m_impl->clearDisplay(color, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayArrow(const vpImagePoint &ip1, const vpImagePoint &ip2, const vpColor &color, unsigned int w,
                              unsigned int h, unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    double a = ip2.get_i() - ip1.get_i();
    double b = ip2.get_j() - ip1.get_j();
    double lg = sqrt(vpMath::sqr(a) + vpMath::sqr(b));
 
    // if ( ( a==0 ) && ( b==0 ) )
    if ((std::fabs(a) <= std::numeric_limits<double>::epsilon()) &&
        (std::fabs(b) <= std::numeric_limits<double>::epsilon())) {
      // DisplayCrossLarge(i1,j1,3,col) ;
    } else {
      a /= lg;
      b /= lg;
 
      vpImagePoint ip3;
      ip3.set_i(ip2.get_i() - w * a);
      ip3.set_j(ip2.get_j() - w * b);
 
      vpImagePoint ip4;
      ip4.set_i(ip3.get_i() - b * h);
      ip4.set_j(ip3.get_j() + a * h);
 
      if (lg > 2 * vpImagePoint::distance(ip2, ip4))
        displayLine(ip2, ip4, color, thickness);
 
      ip4.set_i(ip3.get_i() + b * h);
      ip4.set_j(ip3.get_j() - a * h);
 
      if (lg > 2 * vpImagePoint::distance(ip2, ip4))
        displayLine(ip2, ip4, color, thickness);
 
      displayLine(ip1, ip2, color, thickness);
    }
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayCharString(const vpImagePoint &ip, const char *text, const vpColor &color)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayCharString(ip, text, color, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayCircle(const vpImagePoint &center, unsigned int radius, const vpColor &color, bool fill,
                               unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    if (thickness == 1)
      thickness = 0;
    m_impl->displayCircle(center, radius, color, fill, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayCross(const vpImagePoint &ip, unsigned int cross_size, const vpColor &color,
                              unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    double i = ip.get_i();
    double j = ip.get_j();
    vpImagePoint ip1, ip2;
 
    ip1.set_i(i - cross_size / 2);
    ip1.set_j(j);
    ip2.set_i(i + cross_size / 2);
    ip2.set_j(j);
    displayLine(ip1, ip2, color, thickness);
 
    ip1.set_i(i);
    ip1.set_j(j - cross_size / 2);
    ip2.set_i(i);
    ip2.set_j(j + cross_size / 2);
 
    displayLine(ip1, ip2, color, thickness);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
void vpDisplayX::displayDotLine(const vpImagePoint &ip1, const vpImagePoint &ip2, const vpColor &color,
                                unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    if (thickness == 1)
      thickness = 0;
 
    m_impl->displayDotLine(ip1, ip2, color, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayLine(const vpImagePoint &ip1, const vpImagePoint &ip2, const vpColor &color,
                             unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    if (thickness == 1)
      thickness = 0;
 
    m_impl->displayLine(ip1, ip2, color, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayPoint(const vpImagePoint &ip, const vpColor &color, unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    m_impl->displayPoint(ip, color, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayRectangle(const vpImagePoint &topLeft, unsigned int w, unsigned int h, const vpColor &color,
                                  bool fill, unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    if (thickness == 1)
      thickness = 0;
 
    m_impl->displayRectangle(topLeft, w, h, color, fill, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayRectangle(const vpImagePoint &topLeft, const vpImagePoint &bottomRight, const vpColor &color,
                                  bool fill, unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    if (thickness == 1)
      thickness = 0;
 
    unsigned int w = static_cast<unsigned int>(vpMath::round(bottomRight.get_u() - topLeft.get_u()));
    unsigned int h = static_cast<unsigned int>(vpMath::round(bottomRight.get_v() - topLeft.get_v()));
 
    m_impl->displayRectangle(topLeft, w, h, color, fill, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
void vpDisplayX::displayRectangle(const vpRect &rectangle, const vpColor &color, bool fill, unsigned int thickness)
{
  if (m_displayHasBeenInitialized) {
    if (thickness == 1)
      thickness = 0;
    vpImagePoint topLeft = rectangle.getTopLeft();
    unsigned int w = static_cast<unsigned int>(vpMath::round(rectangle.getWidth()));
    unsigned int h = static_cast<unsigned int>(vpMath::round(rectangle.getHeight()));
    m_impl->displayRectangle(topLeft, w, h, color, fill, thickness, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
bool vpDisplayX::getClick(bool blocking)
{
  bool ret = false;
 
  if (m_displayHasBeenInitialized) {
    vpImagePoint ip;
    vpMouseButton::vpMouseButtonType button;
    ret = m_impl->getClick(ip, button, blocking, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
bool vpDisplayX::getClick(vpImagePoint &ip, bool blocking)
{
  bool ret = false;
 
  if (m_displayHasBeenInitialized) {
    vpMouseButton::vpMouseButtonType button;
    ret = m_impl->getClick(ip, button, blocking, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
bool vpDisplayX::getClick(vpImagePoint &ip, vpMouseButton::vpMouseButtonType &button, bool blocking)
{
  bool ret = false;
 
  if (m_displayHasBeenInitialized) {
    ret = m_impl->getClick(ip, button, blocking, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
bool vpDisplayX::getClickUp(vpImagePoint &ip, vpMouseButton::vpMouseButtonType &button, bool blocking)
{
  bool ret = false;
 
  if (m_displayHasBeenInitialized) {
    ret = m_impl->getClickUp(ip, button, blocking, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
/*
  Gets the displayed image (including the overlay plane)
  and returns an RGBa image. If a scale factor is set using setScale(), the
  size of the image is the size of the downscaled image.
 
  \param I : Image to get.
*/
void vpDisplayX::getImage(vpImage<vpRGBa> &I)
{
  if (m_displayHasBeenInitialized) {
    m_impl->getImage(I, m_width, m_height);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
}
 
unsigned int vpDisplayX::getScreenDepth() { return m_impl->getScreenDepth(); }
 
void vpDisplayX::getScreenSize(unsigned int &w, unsigned int &h) { m_impl->getScreenSize(w, h); }
 
unsigned int vpDisplayX::getScreenWidth()
{
  unsigned int width, height;
  getScreenSize(width, height);
  return width;
}
 
unsigned int vpDisplayX::getScreenHeight()
{
  unsigned int width, height;
  getScreenSize(width, height);
  return height;
}
 
bool vpDisplayX::getKeyboardEvent(bool blocking)
{
  bool ret = false;
 
  if (m_displayHasBeenInitialized) {
    ret = m_impl->getKeyboardEvent(blocking);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
bool vpDisplayX::getKeyboardEvent(std::string &key, bool blocking)
{
  bool ret = false;
  if (m_displayHasBeenInitialized) {
    ret = m_impl->getKeyboardEvent(key, blocking);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
bool vpDisplayX::getPointerMotionEvent(vpImagePoint &ip)
{
 
  bool ret = false;
  if (m_displayHasBeenInitialized) {
    ret = m_impl->getPointerMotionEvent(ip, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
bool vpDisplayX::getPointerPosition(vpImagePoint &ip)
{
  bool ret = false;
  if (m_displayHasBeenInitialized) {
    ret = m_impl->getPointerPosition(ip, m_scale);
  } else {
    throw(vpDisplayException(vpDisplayException::notInitializedError, "X not initialized"));
  }
  return ret;
}
 
#elif !defined(VISP_BUILD_SHARED_LIBS)
// Work around to avoid warning: libvisp_core.a(vpDisplayX.cpp.o) has no
// symbols
void dummy_vpDisplayX(){};
#endif