Representations/Perception/JPEGImage2.cpp

Go to the documentation of this file.

/**
 * @file JPEGImage2.cpp
 * 
 * Implementation of class JPEGImage2
 */ 

#include "Platform/GTAssert.h"
#include "JPEGImage2.h"

JPEGImage2::JPEGImage2(const Image& image)
{
  *this = image;
}

JPEGImage2& JPEGImage2::operator=(const Image& src)
{
  cameraInfo = src.cameraInfo;
  frameNumber = src.frameNumber;
  cameraInfo = src.cameraInfo;
  colorTable = src.colorTable;

  unsigned char srcimage[cameraResolutionHeight_ERS7][cameraResolutionWidth_ERS7][3];
  for( int i = 0; i < cameraInfo.resolutionHeight; ++i)
  {
    for( int j = 0; j < cameraInfo.resolutionWidth; ++j)
    {
      srcimage[i][j][0] = src.image[i][0][j];
      srcimage[i][j][2] = src.image[i][1][j];
      srcimage[i][j][1] = src.image[i][2][j];
    }
  }
  jpeg_compress_struct cInfo;
  jpeg_error_mgr jem;
  cInfo.err = jpeg_std_error(&jem);
  jpeg_create_compress(&cInfo);

  if(!cInfo.dest)
    cInfo.dest = (jpeg_destination_mgr*)
      (*cInfo.mem->alloc_small) ((j_common_ptr) &cInfo,JPOOL_PERMANENT,
                                 sizeof(DestDescriptor));
  cInfo.dest->init_destination = onDestInit;
  cInfo.dest->empty_output_buffer = onDestEmpty;
  cInfo.dest->term_destination = onDestTerm;
  ((DestDescriptor*) cInfo.dest)->theObject = this;

  cInfo.image_width = cameraInfo.resolutionWidth;
  cInfo.image_height = cameraInfo.resolutionHeight;
  cInfo.input_components = 3;
  //cInfo.num_components = 3;
  cInfo.in_color_space = JCS_YCbCr;
  cInfo.jpeg_color_space = JCS_RGB;
  jpeg_set_defaults(&cInfo);
  cInfo.dct_method = JDCT_FASTEST;
  jpeg_set_quality(&cInfo,75,true);

  jpeg_start_compress(&cInfo,true);

  while(cInfo.next_scanline < cInfo.image_height) 
  {
    JSAMPROW rowPointer = const_cast<JSAMPROW>(&srcimage[cInfo.next_scanline][0][0]);
    jpeg_write_scanlines(&cInfo,&rowPointer, 1);
  }

  jpeg_finish_compress(&cInfo);
  jpeg_destroy_compress(&cInfo);
  return *this;
}

void JPEGImage2::toImage(Image& dest) const
{
  dest.cameraInfo = cameraInfo;
  dest.frameNumber = frameNumber;

  jpeg_decompress_struct cInfo;
  jpeg_error_mgr jem;
  cInfo.err = jpeg_std_error(&jem);

  jpeg_create_decompress(&cInfo);

  if(!cInfo.src)
    cInfo.src = (jpeg_source_mgr *)
      (*cInfo.mem->alloc_small)((j_common_ptr) &cInfo,JPOOL_PERMANENT,
                                 sizeof(jpeg_source_mgr));
  cInfo.src->init_source       = onSrcIgnore;
  cInfo.src->fill_input_buffer = onSrcEmpty;
  cInfo.src->skip_input_data   = onSrcSkip;
  cInfo.src->resync_to_restart = jpeg_resync_to_restart;
  cInfo.src->term_source       = onSrcIgnore;
  cInfo.src->bytes_in_buffer = size;
  cInfo.src->next_input_byte = (const JOCTET*) image;

  jpeg_read_header(&cInfo,true);
  jpeg_start_decompress(&cInfo);

  // setup rows
  while (cInfo.output_scanline < cInfo.output_height) 
  {
    JSAMPROW rowPointer = (unsigned char*) (cInfo.output_height == (unsigned) cameraResolutionHeight_ERS210
                          ? &dest.image[cInfo.output_scanline][0][0]
                          : &dest.image[cInfo.output_scanline]
                                       [0][0]);
    (void) jpeg_read_scanlines(&cInfo,&rowPointer,1);
  }

  // decompress
  jpeg_finish_decompress(&cInfo);
  jpeg_destroy_decompress(&cInfo);

  // compatibility with old format: move to correct positions
  if(cInfo.output_height == (unsigned) cameraResolutionHeight_ERS210)
    for(unsigned i = 0; i < cInfo.output_height; ++i)
      for(unsigned c = 2; c > 0; --c)
        memmove(&dest.image[i][c][0], 
                &dest.image[i][0][c * cameraResolutionWidth_ERS210], 
                cameraResolutionWidth_ERS210);

  // clear high resolution y channels
  for(int y = 0; y < dest.cameraInfo.resolutionHeight; ++y)
    for(int c = 3; c < 6; ++c)
      memset(&dest.image[y][c][0], 128, dest.cameraInfo.resolutionWidth);
}

void JPEGImage2::onDestInit(j_compress_ptr cInfo)
{
  JPEGImage2& image = *((DestDescriptor*) cInfo->dest)->theObject;
  cInfo->dest->next_output_byte = (JOCTET*) image.image;
  cInfo->dest->free_in_buffer = image.cameraInfo.resolutionWidth * image.cameraInfo.resolutionHeight;
}

int JPEGImage2::onDestEmpty(j_compress_ptr)
{
  ASSERT(false);
  return false;
}

void JPEGImage2::onDestTerm(j_compress_ptr cInfo)
{
  JPEGImage2& image = *((DestDescriptor*) cInfo->dest)->theObject;
  image.size = (char*) cInfo->dest->next_output_byte - (char*) image.image;
}

void JPEGImage2::onSrcSkip(j_decompress_ptr,long)
{
}

int JPEGImage2::onSrcEmpty(j_decompress_ptr)
{
  ASSERT(false);
  return false;
}

void JPEGImage2::onSrcIgnore(j_decompress_ptr)
{
}

Out& operator<<(Out& stream,const JPEGImage2& image)
{
  ASSERT(image.size);
  stream << image.cameraInfo.resolutionWidth << image.cameraInfo.resolutionHeight << image.frameNumber << image.size;
  stream.write(&image.image,image.size);
  return stream;
}

In& operator>>(In& stream,JPEGImage2& image)
{
  stream >> image.cameraInfo.resolutionWidth >> image.cameraInfo.resolutionHeight >> image.frameNumber >> image.size;
  image.setCameraInfo();
  stream.read(&image.image,image.size);
  return stream;
}

---