Update to 2.0.0 tree from current Fremantle build
[opencv] / src / highgui / grfmt_jpeg2000.cpp
diff --git a/src/highgui/grfmt_jpeg2000.cpp b/src/highgui/grfmt_jpeg2000.cpp
new file mode 100644 (file)
index 0000000..9886495
--- /dev/null
@@ -0,0 +1,529 @@
+/*M///////////////////////////////////////////////////////////////////////////////////////
+//
+//  IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING.
+//
+//  By downloading, copying, installing or using the software you agree to this license.
+//  If you do not agree to this license, do not download, install,
+//  copy or use the software.
+//
+//
+//                           License Agreement
+//                For Open Source Computer Vision Library
+//
+// Copyright (C) 2000-2008, Intel Corporation, all rights reserved.
+// Copyright (C) 2009, Willow Garage Inc., all rights reserved.
+// Third party copyrights are property of their respective owners.
+//
+// Redistribution and use in source and binary forms, with or without modification,
+// are permitted provided that the following conditions are met:
+//
+//   * Redistribution's of source code must retain the above copyright notice,
+//     this list of conditions and the following disclaimer.
+//
+//   * Redistribution's in binary form must reproduce the above copyright notice,
+//     this list of conditions and the following disclaimer in the documentation
+//     and/or other materials provided with the distribution.
+//
+//   * The name of the copyright holders may not be used to endorse or promote products
+//     derived from this software without specific prior written permission.
+//
+// This software is provided by the copyright holders and contributors "as is" and
+// any express or implied warranties, including, but not limited to, the implied
+// warranties of merchantability and fitness for a particular purpose are disclaimed.
+// In no event shall the Intel Corporation or contributors be liable for any direct,
+// indirect, incidental, special, exemplary, or consequential damages
+// (including, but not limited to, procurement of substitute goods or services;
+// loss of use, data, or profits; or business interruption) however caused
+// and on any theory of liability, whether in contract, strict liability,
+// or tort (including negligence or otherwise) arising in any way out of
+// the use of this software, even if advised of the possibility of such damage.
+//
+//M*/
+
+#include "_highgui.h"
+
+#ifdef HAVE_JASPER
+
+#include "grfmt_jpeg2000.h"
+
+#ifdef WIN32
+#define JAS_WIN_MSVC_BUILD 1
+#ifdef __GNUC__
+#define HAVE_STDINT_H 1
+#endif
+#endif
+
+#undef PACKAGE
+#undef PACKAGE_BUGREPORT
+#undef PACKAGE_NAME
+#undef PACKAGE_STRING
+#undef PACKAGE_TARNAME
+#undef PACKAGE_VERSION
+#undef VERSION
+
+#include <jasper/jasper.h>
+// FIXME bad hack
+#undef uchar
+#undef ulong
+
+namespace cv
+{
+
+struct JasperInitializer
+{
+    JasperInitializer() { jas_init(); }
+    ~JasperInitializer() { jas_cleanup(); }
+};
+
+static JasperInitializer initialize_jasper;
+
+
+/////////////////////// Jpeg2KDecoder ///////////////////
+
+Jpeg2KDecoder::Jpeg2KDecoder()
+{
+    m_signature = '\0' + string() + '\0' + string() + '\0' + string("\x0cjP  \r\n\x87\n");
+    m_stream = 0;
+    m_image = 0;
+}
+
+
+Jpeg2KDecoder::~Jpeg2KDecoder()
+{
+}
+
+ImageDecoder Jpeg2KDecoder::newDecoder() const
+{
+    return new Jpeg2KDecoder;
+}
+
+void  Jpeg2KDecoder::close()
+{
+    if( m_stream )
+    {
+        jas_stream_close( (jas_stream_t*)m_stream );
+        m_stream = 0;
+    }
+
+    if( m_image )
+    {
+        jas_image_destroy( (jas_image_t*)m_image );
+        m_image = 0;
+    }
+}
+
+
+bool  Jpeg2KDecoder::readHeader()
+{
+    bool result = false;
+
+    close();
+    jas_stream_t* stream = jas_stream_fopen( m_filename.c_str(), "rb" );
+    m_stream = stream;
+
+    if( stream )
+    {
+        jas_image_t* image = jas_image_decode( stream, -1, 0 );
+        m_image = image;
+        if( image ) {
+            m_width = jas_image_width( image );
+            m_height = jas_image_height( image );
+
+            int cntcmpts = 0; // count the known components
+            int numcmpts = jas_image_numcmpts( image );
+            int depth = 0;
+            for( int i = 0; i < numcmpts; i++ )
+            {
+                int depth_i = jas_image_cmptprec( image, i );
+                depth = MAX(depth, depth_i);
+                if( jas_image_cmpttype( image, i ) > 2 )
+                    continue;
+                cntcmpts++;
+            }
+
+            if( cntcmpts )
+            {
+                m_type = CV_MAKETYPE(depth <= 8 ? CV_8U : CV_16U, cntcmpts > 1 ? 3 : 1);
+                result = true;
+            }
+        }
+    }
+
+    if( !result )
+        close();
+
+    return result;
+}
+
+
+bool  Jpeg2KDecoder::readData( Mat& img )
+{
+    bool result = false;
+    int color = img.channels() > 1;
+    uchar* data = img.data;
+    int step = img.step;
+    jas_stream_t* stream = (jas_stream_t*)m_stream;
+    jas_image_t* image = (jas_image_t*)m_image;
+
+    if( stream && image )
+    {
+        bool convert;
+        int colorspace;
+        if( color )
+        {
+            convert = (jas_image_clrspc( image ) != JAS_CLRSPC_SRGB);
+            colorspace = JAS_CLRSPC_SRGB;
+        }
+        else
+        {
+            convert = (jas_clrspc_fam( jas_image_clrspc( image ) ) != JAS_CLRSPC_FAM_GRAY);
+            colorspace = JAS_CLRSPC_SGRAY; // TODO GENGRAY or SGRAY?
+        }
+
+        // convert to the desired colorspace
+        if( convert )
+        {
+            jas_cmprof_t *clrprof = jas_cmprof_createfromclrspc( colorspace );
+            if( clrprof )
+            {
+                jas_image_t *_img = jas_image_chclrspc( image, clrprof, JAS_CMXFORM_INTENT_RELCLR );
+                if( _img )
+                {
+                    jas_image_destroy( image );
+                    m_image = image = _img;
+                    result = true;
+                }
+                else
+                    fprintf(stderr, "JPEG 2000 LOADER ERROR: cannot convert colorspace\n");
+                jas_cmprof_destroy( clrprof );
+            }
+            else
+                fprintf(stderr, "JPEG 2000 LOADER ERROR: unable to create colorspace\n");
+        }
+        else
+            result = true;
+
+        if( result )
+        {
+            int ncmpts;
+            int cmptlut[3];
+            if( color )
+            {
+                cmptlut[0] = jas_image_getcmptbytype( image, JAS_IMAGE_CT_RGB_B );
+                cmptlut[1] = jas_image_getcmptbytype( image, JAS_IMAGE_CT_RGB_G );
+                cmptlut[2] = jas_image_getcmptbytype( image, JAS_IMAGE_CT_RGB_R );
+                if( cmptlut[0] < 0 || cmptlut[1] < 0 || cmptlut[0] < 0 )
+                    result = false;
+                ncmpts = 3;
+            }
+            else
+            {
+                cmptlut[0] = jas_image_getcmptbytype( image, JAS_IMAGE_CT_GRAY_Y );
+                if( cmptlut[0] < 0 )
+                    result = false;
+                ncmpts = 1;
+            }
+
+            if( result )
+            {
+                for( int i = 0; i < ncmpts; i++ )
+                {
+                    int maxval = 1 << jas_image_cmptprec( image, cmptlut[i] );
+                    int offset =  jas_image_cmptsgnd( image, cmptlut[i] ) ? maxval / 2 : 0;
+
+                    int yend = jas_image_cmptbry( image, cmptlut[i] );
+                    int ystep = jas_image_cmptvstep( image, cmptlut[i] );
+                    int xend = jas_image_cmptbrx( image, cmptlut[i] );
+                    int xstep = jas_image_cmpthstep( image, cmptlut[i] );
+
+                    jas_matrix_t *buffer = jas_matrix_create( yend / ystep, xend / xstep );
+                    if( buffer )
+                    {
+                        if( !jas_image_readcmpt( image, cmptlut[i], 0, 0, xend / xstep, yend / ystep, buffer ))
+                        {
+                            if( img.depth() == CV_8U )
+                                result = readComponent8u( data + i, buffer, step, cmptlut[i], maxval, offset, ncmpts );
+                            else
+                                result = readComponent16u( ((unsigned short *)data) + i, buffer, step / 2, cmptlut[i], maxval, offset, ncmpts );
+                            if( !result )
+                            {
+                                i = ncmpts;
+                                result = false;
+                            }
+                        }
+                        jas_matrix_destroy( buffer );
+                    }
+                }
+            }
+        }
+        else
+            fprintf(stderr, "JPEG2000 LOADER ERROR: colorspace conversion failed\n" );
+    }
+
+    close();
+
+    return result;
+}
+
+
+bool  Jpeg2KDecoder::readComponent8u( uchar *data, void *_buffer,
+                                      int step, int cmpt,
+                                      int maxval, int offset, int ncmpts )
+{
+    jas_matrix_t* buffer = (jas_matrix_t*)_buffer;
+    jas_image_t* image = (jas_image_t*)m_image;
+    int xstart = jas_image_cmpttlx( image, cmpt );
+    int xend = jas_image_cmptbrx( image, cmpt );
+    int xstep = jas_image_cmpthstep( image, cmpt );
+    int xoffset = jas_image_tlx( image );
+    int ystart = jas_image_cmpttly( image, cmpt );
+    int yend = jas_image_cmptbry( image, cmpt );
+    int ystep = jas_image_cmptvstep( image, cmpt );
+    int yoffset = jas_image_tly( image );
+    int x, y, x1, y1, j;
+    int rshift = cvRound(std::log(maxval/256.)/std::log(2.));
+    int lshift = MAX(0, -rshift);
+    rshift = MAX(0, rshift);
+    int delta = (rshift > 0 ? 1 << (rshift - 1) : 0) + offset;
+
+    for( y = 0; y < yend - ystart; )
+    {
+        jas_seqent_t* pix_row = &jas_matrix_get( buffer, y / ystep, 0 );
+        uchar* dst = data + (y - yoffset) * step - xoffset;
+
+        if( xstep == 1 )
+        {
+            if( maxval == 256 && offset == 0 )
+                for( x = 0; x < xend - xstart; x++ )
+                {
+                    int pix = pix_row[x];
+                    dst[x*ncmpts] = CV_CAST_8U(pix);
+                }
+            else
+                for( x = 0; x < xend - xstart; x++ )
+                {
+                    int pix = ((pix_row[x] + delta) >> rshift) << lshift;
+                    dst[x*ncmpts] = CV_CAST_8U(pix);
+                }
+        }
+        else if( xstep == 2 && offset == 0 )
+            for( x = 0, j = 0; x < xend - xstart; x += 2, j++ )
+            {
+                int pix = ((pix_row[j] + delta) >> rshift) << lshift;
+                dst[x*ncmpts] = dst[(x+1)*ncmpts] = CV_CAST_8U(pix);
+            }
+        else
+            for( x = 0, j = 0; x < xend - xstart; j++ )
+            {
+                int pix = ((pix_row[j] + delta) >> rshift) << lshift;
+                pix = CV_CAST_8U(pix);
+                for( x1 = x + xstep; x < x1; x++ )
+                    dst[x*ncmpts] = (uchar)pix;
+            }
+        y1 = y + ystep;
+        for( ++y; y < y1; y++, dst += step )
+            for( x = 0; x < xend - xstart; x++ )
+                dst[x*ncmpts + step] = dst[x*ncmpts];
+    }
+
+    return true;
+}
+
+
+bool  Jpeg2KDecoder::readComponent16u( unsigned short *data, void *_buffer,
+                                       int step, int cmpt,
+                                       int maxval, int offset, int ncmpts )
+{
+    jas_matrix_t* buffer = (jas_matrix_t*)_buffer;
+    jas_image_t* image = (jas_image_t*)m_image;
+    int xstart = jas_image_cmpttlx( image, cmpt );
+    int xend = jas_image_cmptbrx( image, cmpt );
+    int xstep = jas_image_cmpthstep( image, cmpt );
+    int xoffset = jas_image_tlx( image );
+    int ystart = jas_image_cmpttly( image, cmpt );
+    int yend = jas_image_cmptbry( image, cmpt );
+    int ystep = jas_image_cmptvstep( image, cmpt );
+    int yoffset = jas_image_tly( image );
+    int x, y, x1, y1, j;
+    int rshift = cvRound(std::log(maxval/65536.)/std::log(2.));
+    int lshift = MAX(0, -rshift);
+    rshift = MAX(0, rshift);
+    int delta = (rshift > 0 ? 1 << (rshift - 1) : 0) + offset;
+
+    for( y = 0; y < yend - ystart; )
+    {
+        jas_seqent_t* pix_row = &jas_matrix_get( buffer, y / ystep, 0 );
+        ushort* dst = data + (y - yoffset) * step - xoffset;
+
+        if( xstep == 1 )
+        {
+            if( maxval == 65536 && offset == 0 )
+                for( x = 0; x < xend - xstart; x++ )
+                {
+                    int pix = pix_row[x];
+                    dst[x*ncmpts] = CV_CAST_16U(pix);
+                }
+            else
+                for( x = 0; x < xend - xstart; x++ )
+                {
+                    int pix = ((pix_row[x] + delta) >> rshift) << lshift;
+                    dst[x*ncmpts] = CV_CAST_16U(pix);
+                }
+        }
+        else if( xstep == 2 && offset == 0 )
+            for( x = 0, j = 0; x < xend - xstart; x += 2, j++ )
+            {
+                int pix = ((pix_row[j] + delta) >> rshift) << lshift;
+                dst[x*ncmpts] = dst[(x+1)*ncmpts] = CV_CAST_16U(pix);
+            }
+        else
+            for( x = 0, j = 0; x < xend - xstart; j++ )
+            {
+                int pix = ((pix_row[j] + delta) >> rshift) << lshift;
+                pix = CV_CAST_16U(pix);
+                for( x1 = x + xstep; x < x1; x++ )
+                    dst[x*ncmpts] = (ushort)pix;
+            }
+        y1 = y + ystep;
+        for( ++y; y < y1; y++, dst += step )
+            for( x = 0; x < xend - xstart; x++ )
+                dst[x*ncmpts + step] = dst[x*ncmpts];
+    }
+
+    return true;
+}
+
+
+/////////////////////// Jpeg2KEncoder ///////////////////
+
+
+Jpeg2KEncoder::Jpeg2KEncoder()
+{
+    m_description = "JPEG-2000 files (*.jp2)";
+}
+
+
+Jpeg2KEncoder::~Jpeg2KEncoder()
+{
+}
+
+ImageEncoder Jpeg2KEncoder::newEncoder() const
+{
+    return new Jpeg2KEncoder;
+}
+
+bool  Jpeg2KEncoder::isFormatSupported( int depth ) const
+{
+    return depth == CV_8U || depth == CV_16U;
+}
+
+
+bool  Jpeg2KEncoder::write( const Mat& _img, const vector<int>& )
+{
+    int width = _img.cols, height = _img.rows;
+    int depth = _img.depth(), channels = _img.channels();
+    depth = depth == CV_8U ? 8 : 16;
+
+    if( channels > 3 || channels < 1 )
+        return false;
+
+    jas_image_cmptparm_t component_info[3];
+    for( int i = 0; i < channels; i++ )
+    {
+        component_info[i].tlx = 0;
+        component_info[i].tly = 0;
+        component_info[i].hstep = 1;
+        component_info[i].vstep = 1;
+        component_info[i].width = width;
+        component_info[i].height = height;
+        component_info[i].prec = depth;
+        component_info[i].sgnd = 0;
+    }
+    jas_image_t *img = jas_image_create( channels, component_info, (channels == 1) ? JAS_CLRSPC_SGRAY : JAS_CLRSPC_SRGB );
+    if( !img )
+        return false;
+
+    if(channels == 1)
+        jas_image_setcmpttype( img, 0, JAS_IMAGE_CT_GRAY_Y );
+    else
+    {
+        jas_image_setcmpttype( img, 0, JAS_IMAGE_CT_RGB_B );
+        jas_image_setcmpttype( img, 1, JAS_IMAGE_CT_RGB_G );
+        jas_image_setcmpttype( img, 2, JAS_IMAGE_CT_RGB_R );
+    }
+
+    bool result;
+    if( depth == 8 )
+        result = writeComponent8u( img, _img );
+    else
+        result = writeComponent16u( img, _img );
+    if( result )
+    {
+        jas_stream_t *stream = jas_stream_fopen( m_filename.c_str(), "wb" );
+        if( stream )
+        {
+            result = !jas_image_encode( img, stream, jas_image_strtofmt( (char*)"jp2" ), (char*)"" );
+
+            jas_stream_close( stream );
+        }
+
+    }
+    jas_image_destroy( img );
+
+    return result;
+}
+
+
+bool  Jpeg2KEncoder::writeComponent8u( void *__img, const Mat& _img )
+{
+    jas_image_t* img = (jas_image_t*)__img;
+    int w = _img.cols, h = _img.rows, ncmpts = _img.channels();
+    jas_matrix_t *row = jas_matrix_create( 1, w );
+    if(!row)
+        return false;
+
+    for( int y = 0; y < h; y++ )
+    {
+        uchar* data = _img.data + _img.step*y;
+        for( int i = 0; i < ncmpts; i++ )
+        {
+            for( int x = 0; x < w; x++)
+                jas_matrix_setv( row, x, data[x * ncmpts + i] );
+            jas_image_writecmpt( img, i, 0, y, w, 1, row );
+        }
+    }
+
+    jas_matrix_destroy( row );
+    return true;
+}
+
+
+bool  Jpeg2KEncoder::writeComponent16u( void *__img, const Mat& _img )
+{
+    jas_image_t* img = (jas_image_t*)__img;
+    int w = _img.cols, h = _img.rows, ncmpts = _img.channels();
+    jas_matrix_t *row = jas_matrix_create( 1, w );
+    if(!row)
+        return false;
+
+    for( int y = 0; y < h; y++ )
+    {
+        uchar* data = _img.data + _img.step*y;
+        for( int i = 0; i < ncmpts; i++ )
+        {
+            for( int x = 0; x < w; x++)
+                jas_matrix_setv( row, x, data[x * ncmpts + i] );
+            jas_image_writecmpt( img, i, 0, y, w, 1, row );
+        }
+    }
+
+    jas_matrix_destroy( row );
+
+    return true;
+}
+
+}
+
+#endif
+
+/* End of file. */