gambas-source-code/main/lib/image.effect/kimageeffect.cpp

5044 lines
168 KiB
C++
Raw Normal View History

/***************************************************************************
kimageeffect.cpp
(c) 2000-2017 Benoît Minisini <gambas@users.sourceforge.net>
This program 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, or (at your option)
any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
MA 02110-1301, USA.
***************************************************************************/
/* This file is part of the KDE libraries
Copyright (C) 1998, 1999, 2001, 2002 Daniel M. Duley <mosfet@kde.org>
(C) 1998, 1999 Christian Tibirna <ctibirna@total.net>
(C) 1998, 1999 Dirk A. Mueller <mueller@kde.org>
(C) 1999 Geert Jansen <g.t.jansen@stud.tue.nl>
(C) 2000 Josef Weidendorfer <weidendo@in.tum.de>
Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions
are met:
1. Redistributions of source code must retain the above copyright
notice, this list of conditions and the following disclaimer.
2. Redistributions 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.
THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
*/
// $Id: kimageeffect.cpp,v 1.50.2.1 2004/01/23 19:04:06 orlovich Exp $
#include <math.h>
#include <assert.h>
#include <stdlib.h>
#include <iostream>
#include "qcolor.h"
#include "qimage.h"
#include "kimageeffect.h"
#include "kcpuinfo.h"
#include <config.h>
#if 0
#if defined(__i386__) && ( defined(__GNUC__) || defined(__INTEL_COMPILER) )
# if defined( HAVE_X86_MMX )
# define USE_MMX_INLINE_ASM
# endif
# if defined( HAVE_X86_SSE2 )
# define USE_SSE2_INLINE_ASM
# endif
#endif
#endif
//======================================================================
//
// Utility stuff for effects ported from ImageMagick to QImage
//
//======================================================================
#define MaxRGB 255L
#define DegreesToRadians(x) ((x)*M_PI/180.0)
#define MagickSQ2PI 2.50662827463100024161235523934010416269302368164062
#define MagickEpsilon 1.0e-12
#define MagickPI 3.14159265358979323846264338327950288419716939937510
static inline unsigned int intensityValue(unsigned int color)
{
return((unsigned int)((0.299*qRed(color) +
0.587*qGreen(color) +
0.1140000000000001*qBlue(color))));
}
/*static inline void liberateMemory(void **memory)
{
assert(memory != (void **)NULL);
if(*memory == (void *)NULL) return;
free(*memory);
*memory=(void *) NULL;
}*/
#define liberateMemory(_pmemory) \
({ \
free(*(_pmemory)); \
*(_pmemory) = NULL; \
})
struct double_packet
{
double red;
double green;
double blue;
double alpha;
};
struct short_packet
{
unsigned short int red;
unsigned short int green;
unsigned short int blue;
unsigned short int alpha;
};
// Functions for managing BGRA images
static inline uint invert(uint col)
{
return ((col & 0xFF)) << 16 | ((col & 0xFF0000)) >> 16 | (col & 0xFF00FF00);
}
#define INVERT(_exp) \
if (image.inverted()) \
{ \
_exp = invert(_exp); \
}
//======================================================================
//
// Gradient effects
//
//======================================================================
QImage KImageEffect::gradient(const QSize &size, const QColor &ca,
const QColor &cb, GradientType eff, int ncols)
{
int rDiff, gDiff, bDiff;
int rca, gca, bca, rcb, gcb, bcb;
QImage image(size, false);
if (size.width() == 0 || size.height() == 0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::gradient: invalid image" << std::endl;
#endif
return image;
}
register int x, y;
rDiff = (rcb = cb.red()) - (rca = ca.red());
gDiff = (gcb = cb.green()) - (gca = ca.green());
bDiff = (bcb = cb.blue()) - (bca = ca.blue());
if( eff == VerticalGradient || eff == HorizontalGradient ){
uint *p;
uint rgb;
register int rl = rca << 16;
register int gl = gca << 16;
register int bl = bca << 16;
if( eff == VerticalGradient ) {
int rcdelta = ((1<<16) / size.height()) * rDiff;
int gcdelta = ((1<<16) / size.height()) * gDiff;
int bcdelta = ((1<<16) / size.height()) * bDiff;
for ( y = 0; y < size.height(); y++ ) {
p = (uint *) image.scanLine(y);
rl += rcdelta;
gl += gcdelta;
bl += bcdelta;
rgb = qRgb( (rl>>16), (gl>>16), (bl>>16) );
INVERT(rgb);
for( x = 0; x < size.width(); x++ ) {
*p = rgb;
p++;
}
}
}
else { // must be HorizontalGradient
unsigned int *o_src = (unsigned int *)image.scanLine(0);
unsigned int *src = o_src;
uint rgb;
int rcdelta = ((1<<16) / size.width()) * rDiff;
int gcdelta = ((1<<16) / size.width()) * gDiff;
int bcdelta = ((1<<16) / size.width()) * bDiff;
for( x = 0; x < size.width(); x++) {
rl += rcdelta;
gl += gcdelta;
bl += bcdelta;
rgb = qRgb( (rl>>16), (gl>>16), (bl>>16));
INVERT(rgb);
*src++ = rgb;
}
src = o_src;
// Believe it or not, manually copying in a for loop is faster
// than calling memcpy for each scanline (on the order of ms...).
// I think this is due to the function call overhead (mosfet).
for (y = 1; y < size.height(); ++y) {
p = (unsigned int *)image.scanLine(y);
src = o_src;
for(x=0; x < size.width(); ++x)
*p++ = *src++;
}
}
}
else {
float rfd, gfd, bfd;
float rd = rca, gd = gca, bd = bca;
unsigned char *xtable[3];
unsigned char *ytable[3];
unsigned int w = size.width(), h = size.height();
xtable[0] = new unsigned char[w];
xtable[1] = new unsigned char[w];
xtable[2] = new unsigned char[w];
ytable[0] = new unsigned char[h];
ytable[1] = new unsigned char[h];
ytable[2] = new unsigned char[h];
w*=2, h*=2;
if ( eff == DiagonalGradient || eff == CrossDiagonalGradient) {
// Diagonal dgradient code inspired by BlackBox (mosfet)
// BlackBox dgradient is (C) Brad Hughes, <bhughes@tcac.net> and
// Mike Cole <mike@mydot.com>.
rfd = (float)rDiff/w;
gfd = (float)gDiff/w;
bfd = (float)bDiff/w;
int dir;
for (x = 0; x < size.width(); x++, rd+=rfd, gd+=gfd, bd+=bfd) {
dir = eff == DiagonalGradient? x : size.width() - x - 1;
xtable[0][dir] = (unsigned char) rd;
xtable[1][dir] = (unsigned char) gd;
xtable[2][dir] = (unsigned char) bd;
}
rfd = (float)rDiff/h;
gfd = (float)gDiff/h;
bfd = (float)bDiff/h;
rd = gd = bd = 0;
for (y = 0; y < size.height(); y++, rd+=rfd, gd+=gfd, bd+=bfd) {
ytable[0][y] = (unsigned char) rd;
ytable[1][y] = (unsigned char) gd;
ytable[2][y] = (unsigned char) bd;
}
for (y = 0; y < size.height(); y++) {
unsigned int *scanline = (unsigned int *)image.scanLine(y);
for (x = 0; x < size.width(); x++) {
scanline[x] = qRgb(xtable[0][x] + ytable[0][y],
xtable[1][x] + ytable[1][y],
xtable[2][x] + ytable[2][y]);
INVERT(scanline[x]);
}
}
}
else if (eff == RectangleGradient ||
eff == PyramidGradient ||
eff == PipeCrossGradient ||
eff == EllipticGradient)
{
int rSign = rDiff>0? 1: -1;
int gSign = gDiff>0? 1: -1;
int bSign = bDiff>0? 1: -1;
rfd = (float)rDiff / size.width();
gfd = (float)gDiff / size.width();
bfd = (float)bDiff / size.width();
rd = (float)rDiff/2;
gd = (float)gDiff/2;
bd = (float)bDiff/2;
for (x = 0; x < size.width(); x++, rd-=rfd, gd-=gfd, bd-=bfd)
{
xtable[0][x] = (unsigned char) abs((int)rd);
xtable[1][x] = (unsigned char) abs((int)gd);
xtable[2][x] = (unsigned char) abs((int)bd);
}
rfd = (float)rDiff/size.height();
gfd = (float)gDiff/size.height();
bfd = (float)bDiff/size.height();
rd = (float)rDiff/2;
gd = (float)gDiff/2;
bd = (float)bDiff/2;
for (y = 0; y < size.height(); y++, rd-=rfd, gd-=gfd, bd-=bfd)
{
ytable[0][y] = (unsigned char) abs((int)rd);
ytable[1][y] = (unsigned char) abs((int)gd);
ytable[2][y] = (unsigned char) abs((int)bd);
}
unsigned int rgb;
int h = (size.height()+1)>>1;
for (y = 0; y < h; y++) {
unsigned int *sl1 = (unsigned int *)image.scanLine(y);
unsigned int *sl2 = (unsigned int *)image.scanLine(QMAX(size.height()-y-1, y));
int w = (size.width()+1)>>1;
int x2 = size.width()-1;
for (x = 0; x < w; x++, x2--) {
rgb = 0;
if (eff == PyramidGradient) {
rgb = qRgb(rcb-rSign*(xtable[0][x]+ytable[0][y]),
gcb-gSign*(xtable[1][x]+ytable[1][y]),
bcb-bSign*(xtable[2][x]+ytable[2][y]));
}
else if (eff == RectangleGradient) {
rgb = qRgb(rcb - rSign *
QMAX(xtable[0][x], ytable[0][y]) * 2,
gcb - gSign *
QMAX(xtable[1][x], ytable[1][y]) * 2,
bcb - bSign *
QMAX(xtable[2][x], ytable[2][y]) * 2);
}
else if (eff == PipeCrossGradient) {
rgb = qRgb(rcb - rSign *
QMIN(xtable[0][x], ytable[0][y]) * 2,
gcb - gSign *
QMIN(xtable[1][x], ytable[1][y]) * 2,
bcb - bSign *
QMIN(xtable[2][x], ytable[2][y]) * 2);
}
else if (eff == EllipticGradient) {
rgb = qRgb(rcb - rSign *
(int)sqrt((xtable[0][x]*xtable[0][x] +
ytable[0][y]*ytable[0][y])*2.0),
gcb - gSign *
(int)sqrt((xtable[1][x]*xtable[1][x] +
ytable[1][y]*ytable[1][y])*2.0),
bcb - bSign *
(int)sqrt((xtable[2][x]*xtable[2][x] +
ytable[2][y]*ytable[2][y])*2.0));
}
//INVERT(rgb);
sl1[x] = sl2[x] = rgb;
sl1[x2] = sl2[x2] = rgb;
}
}
if (image.inverted())
image.invert();
}
delete [] xtable[0];
delete [] xtable[1];
delete [] xtable[2];
delete [] ytable[0];
delete [] ytable[1];
delete [] ytable[2];
}
#if 0
// dither if necessary
if (ncols && (QPixmap::defaultDepth() < 15 )) {
if ( ncols < 2 || ncols > 256 )
ncols = 3;
QColor *dPal = new QColor[ncols];
for (int i=0; i<ncols; i++) {
dPal[i].setRgb ( rca + rDiff * i / ( ncols - 1 ),
gca + gDiff * i / ( ncols - 1 ),
bca + bDiff * i / ( ncols - 1 ) );
}
dither(image, dPal, ncols);
delete [] dPal;
}
#endif
return image;
}
// -----------------------------------------------------------------------------
//CT this was (before Dirk A. Mueller's speedup changes)
// merely the same code as in the above method, but it's supposedly
// way less performant since it introduces a lot of supplementary tests
// and simple math operations for the calculus of the balance.
// (surprizingly, it isn't less performant, in the contrary :-)
// Yes, I could have merged them, but then the excellent performance of
// the balanced code would suffer with no other gain than a mere
// source code and byte code size economy.
QImage KImageEffect::unbalancedGradient(const QSize &size, const QColor &ca,
const QColor &cb, GradientType eff, int xfactor, int yfactor,
int ncols)
{
int dir; // general parameter used for direction switches
bool _xanti = false , _yanti = false;
if (xfactor < 0) _xanti = true; // negative on X direction
if (yfactor < 0) _yanti = true; // negative on Y direction
xfactor = abs(xfactor);
yfactor = abs(yfactor);
if (!xfactor) xfactor = 1;
if (!yfactor) yfactor = 1;
if (xfactor > 200 ) xfactor = 200;
if (yfactor > 200 ) yfactor = 200;
// float xbal = xfactor/5000.;
// float ybal = yfactor/5000.;
float xbal = xfactor/30./size.width();
float ybal = yfactor/30./size.height();
float rat;
int rDiff, gDiff, bDiff;
int rca, gca, bca, rcb, gcb, bcb;
QImage image(size, false);
if (size.width() == 0 || size.height() == 0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::unbalancedGradient : invalid image\n";
#endif
return image;
}
register int x, y;
unsigned int *scanline;
rDiff = (rcb = cb.red()) - (rca = ca.red());
gDiff = (gcb = cb.green()) - (gca = ca.green());
bDiff = (bcb = cb.blue()) - (bca = ca.blue());
if( eff == VerticalGradient || eff == HorizontalGradient){
QColor cRow;
uint *p;
uint rgbRow;
if( eff == VerticalGradient) {
for ( y = 0; y < size.height(); y++ ) {
dir = _yanti ? y : size.height() - 1 - y;
p = (uint *) image.scanLine(dir);
rat = 1 - exp( - (float)y * ybal );
cRow.setRgb( rcb - (int) ( rDiff * rat ),
gcb - (int) ( gDiff * rat ),
bcb - (int) ( bDiff * rat ) );
rgbRow = cRow.rgb();
INVERT(rgbRow);
for( x = 0; x < size.width(); x++ ) {
*p = rgbRow;
p++;
}
}
}
else {
unsigned int *src = (unsigned int *)image.scanLine(0);
for(x = 0; x < size.width(); x++ )
{
dir = _xanti ? x : size.width() - 1 - x;
rat = 1 - exp( - (float)x * xbal );
src[dir] = qRgb(rcb - (int) ( rDiff * rat ),
gcb - (int) ( gDiff * rat ),
bcb - (int) ( bDiff * rat ));
INVERT(src[dir]);
}
// Believe it or not, manually copying in a for loop is faster
// than calling memcpy for each scanline (on the order of ms...).
// I think this is due to the function call overhead (mosfet).
for(y = 1; y < size.height(); ++y)
{
scanline = (unsigned int *)image.scanLine(y);
for(x=0; x < size.width(); ++x)
scanline[x] = src[x];
}
}
}
else {
int w=size.width(), h=size.height();
unsigned char *xtable[3];
unsigned char *ytable[3];
xtable[0] = new unsigned char[w];
xtable[1] = new unsigned char[w];
xtable[2] = new unsigned char[w];
ytable[0] = new unsigned char[h];
ytable[1] = new unsigned char[h];
ytable[2] = new unsigned char[h];
if ( eff == DiagonalGradient || eff == CrossDiagonalGradient)
{
for (x = 0; x < w; x++) {
dir = _xanti ? x : w - 1 - x;
rat = 1 - exp( - (float)x * xbal );
xtable[0][dir] = (unsigned char) ( rDiff/2 * rat );
xtable[1][dir] = (unsigned char) ( gDiff/2 * rat );
xtable[2][dir] = (unsigned char) ( bDiff/2 * rat );
}
for (y = 0; y < h; y++) {
dir = _yanti ? y : h - 1 - y;
rat = 1 - exp( - (float)y * ybal );
ytable[0][dir] = (unsigned char) ( rDiff/2 * rat );
ytable[1][dir] = (unsigned char) ( gDiff/2 * rat );
ytable[2][dir] = (unsigned char) ( bDiff/2 * rat );
}
for (y = 0; y < h; y++) {
unsigned int *scanline = (unsigned int *)image.scanLine(y);
for (x = 0; x < w; x++) {
scanline[x] = qRgb(rcb - (xtable[0][x] + ytable[0][y]),
gcb - (xtable[1][x] + ytable[1][y]),
bcb - (xtable[2][x] + ytable[2][y]));
INVERT(scanline[x]);
}
}
}
else if (eff == RectangleGradient ||
eff == PyramidGradient ||
eff == PipeCrossGradient ||
eff == EllipticGradient)
{
int rSign = rDiff>0? 1: -1;
int gSign = gDiff>0? 1: -1;
int bSign = bDiff>0? 1: -1;
for (x = 0; x < w; x++)
{
dir = _xanti ? x : w - 1 - x;
rat = 1 - exp( - (float)x * xbal );
xtable[0][dir] = (unsigned char) abs((int)(rDiff*(0.5-rat)));
xtable[1][dir] = (unsigned char) abs((int)(gDiff*(0.5-rat)));
xtable[2][dir] = (unsigned char) abs((int)(bDiff*(0.5-rat)));
}
for (y = 0; y < h; y++)
{
dir = _yanti ? y : h - 1 - y;
rat = 1 - exp( - (float)y * ybal );
ytable[0][dir] = (unsigned char) abs((int)(rDiff*(0.5-rat)));
ytable[1][dir] = (unsigned char) abs((int)(gDiff*(0.5-rat)));
ytable[2][dir] = (unsigned char) abs((int)(bDiff*(0.5-rat)));
}
for (y = 0; y < h; y++) {
unsigned int *scanline = (unsigned int *)image.scanLine(y);
for (x = 0; x < w; x++) {
if (eff == PyramidGradient)
{
scanline[x] = qRgb(rcb-rSign*(xtable[0][x]+ytable[0][y]),
gcb-gSign*(xtable[1][x]+ytable[1][y]),
bcb-bSign*(xtable[2][x]+ytable[2][y]));
}
if (eff == RectangleGradient)
{
scanline[x] = qRgb(rcb - rSign *
QMAX(xtable[0][x], ytable[0][y]) * 2,
gcb - gSign *
QMAX(xtable[1][x], ytable[1][y]) * 2,
bcb - bSign *
QMAX(xtable[2][x], ytable[2][y]) * 2);
}
if (eff == PipeCrossGradient)
{
scanline[x] = qRgb(rcb - rSign *
QMIN(xtable[0][x], ytable[0][y]) * 2,
gcb - gSign *
QMIN(xtable[1][x], ytable[1][y]) * 2,
bcb - bSign *
QMIN(xtable[2][x], ytable[2][y]) * 2);
}
if (eff == EllipticGradient)
{
scanline[x] = qRgb(rcb - rSign *
(int)sqrt((xtable[0][x]*xtable[0][x] +
ytable[0][y]*ytable[0][y])*2.0),
gcb - gSign *
(int)sqrt((xtable[1][x]*xtable[1][x] +
ytable[1][y]*ytable[1][y])*2.0),
bcb - bSign *
(int)sqrt((xtable[2][x]*xtable[2][x] +
ytable[2][y]*ytable[2][y])*2.0));
}
INVERT(scanline[x]);
}
}
}
#if 0
if (ncols && (QPixmap::defaultDepth() < 15 )) {
if ( ncols < 2 || ncols > 256 )
ncols = 3;
QColor *dPal = new QColor[ncols];
for (int i=0; i<ncols; i++) {
dPal[i].setRgb ( rca + rDiff * i / ( ncols - 1 ),
gca + gDiff * i / ( ncols - 1 ),
bca + bDiff * i / ( ncols - 1 ) );
}
dither(image, dPal, ncols);
delete [] dPal;
}
#endif
delete [] xtable[0];
delete [] xtable[1];
delete [] xtable[2];
delete [] ytable[0];
delete [] ytable[1];
delete [] ytable[2];
}
return image;
}
/**
Types for MMX and SSE packing of colors, for safe constraints
*/
namespace {
struct KIE4Pack
{
Q_UINT16 data[4];
};
struct KIE8Pack
{
Q_UINT16 data[8];
};
}
//======================================================================
//
// Intensity effects
//
//======================================================================
/* This builds a 256 byte unsigned char lookup table with all
* the possible percent values prior to applying the effect, then uses
* integer math for the pixels. For any image larger than 9x9 this will be
* less expensive than doing a float operation on the 3 color components of
* each pixel. (mosfet)
*/
QImage& KImageEffect::intensity(QImage &image, float percent)
{
if (image.width() == 0 || image.height() == 0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::intensity : invalid image\n";
#endif
return image;
}
int segColors = image.depth() > 8 ? 256 : image.numColors();
int pixels = image.depth() > 8 ? image.width()*image.height() :
image.numColors();
unsigned int *data = image.depth() > 8 ? (unsigned int *)image.bits() :
(unsigned int *)image.colorTable();
bool brighten = (percent >= 0);
if(percent < 0)
percent = -percent;
fprintf(stderr, "image: %d x %d = %d\n", image.width(), image.height(), pixels);
#ifdef USE_MMX_INLINE_ASM
bool haveMMX = KCPUInfo::haveExtension( KCPUInfo::IntelMMX );
if(haveMMX)
{
Q_UINT16 p = Q_UINT16(256.0f*(percent));
KIE4Pack mult = {{p,p,p,0}};
__asm__ __volatile__(
"pxor %%mm7, %%mm7\n\t" // zero mm7 for unpacking
"movq (%0), %%mm6\n\t" // copy intensity change to mm6
: : "r"(&mult), "m"(mult));
unsigned int rem = pixels % 4;
pixels -= rem;
Q_UINT32 *end = ( data + pixels );
if (brighten)
{
while ( data != end ) {
__asm__ __volatile__(
"movq (%0), %%mm0\n\t"
"movq 8(%0), %%mm4\n\t" // copy 4 pixels of data to mm0 and mm4
"movq %%mm0, %%mm1\n\t"
"movq %%mm0, %%mm3\n\t"
"movq %%mm4, %%mm5\n\t" // copy to registers for unpacking
"punpcklbw %%mm7, %%mm0\n\t"
"punpckhbw %%mm7, %%mm1\n\t" // unpack the two pixels from mm0
"pmullw %%mm6, %%mm0\n\t"
"punpcklbw %%mm7, %%mm4\n\t"
"pmullw %%mm6, %%mm1\n\t" // multiply by intensity*256
"psrlw $8, %%mm0\n\t" // divide by 256
"pmullw %%mm6, %%mm4\n\t"
"psrlw $8, %%mm1\n\t"
"psrlw $8, %%mm4\n\t"
"packuswb %%mm1, %%mm0\n\t" // pack solution into mm0. saturates at 255
"movq %%mm5, %%mm1\n\t"
"punpckhbw %%mm7, %%mm1\n\t" // unpack 4th pixel in mm1
"pmullw %%mm6, %%mm1\n\t"
"paddusb %%mm3, %%mm0\n\t" // add intesity result to original of mm0
"psrlw $8, %%mm1\n\t"
"packuswb %%mm1, %%mm4\n\t" // pack upper two pixels into mm4
"movq %%mm0, (%0)\n\t" // rewrite to memory lower two pixels
"paddusb %%mm5, %%mm4\n\t"
"movq %%mm4, 8(%0)\n\t" // rewrite upper two pixels
: : "r"(data) );
data += 4;
}
end += rem;
while ( data != end ) {
__asm__ __volatile__(
"movd (%0), %%mm0\n\t" // repeat above but for
"punpcklbw %%mm7, %%mm0\n\t" // one pixel at a time
"movq %%mm0, %%mm3\n\t"
"pmullw %%mm6, %%mm0\n\t"
"psrlw $8, %%mm0\n\t"
"paddw %%mm3, %%mm0\n\t"
"packuswb %%mm0, %%mm0\n\t"
"movd %%mm0, (%0)\n\t"
: : "r"(data) );
data++;
}
}
else
{
while ( data != end ) {
__asm__ __volatile__(
"movq (%0), %%mm0\n\t"
"movq 8(%0), %%mm4\n\t"
"movq %%mm0, %%mm1\n\t"
"movq %%mm0, %%mm3\n\t"
"movq %%mm4, %%mm5\n\t"
"punpcklbw %%mm7, %%mm0\n\t"
"punpckhbw %%mm7, %%mm1\n\t"
"pmullw %%mm6, %%mm0\n\t"
"punpcklbw %%mm7, %%mm4\n\t"
"pmullw %%mm6, %%mm1\n\t"
"psrlw $8, %%mm0\n\t"
"pmullw %%mm6, %%mm4\n\t"
"psrlw $8, %%mm1\n\t"
"psrlw $8, %%mm4\n\t"
"packuswb %%mm1, %%mm0\n\t"
"movq %%mm5, %%mm1\n\t"
"punpckhbw %%mm7, %%mm1\n\t"
"pmullw %%mm6, %%mm1\n\t"
"psubusb %%mm0, %%mm3\n\t" // subtract darkening amount
"psrlw $8, %%mm1\n\t"
"packuswb %%mm1, %%mm4\n\t"
"movq %%mm3, (%0)\n\t"
"psubusb %%mm4, %%mm5\n\t" // only change for this version is
"movq %%mm5, 8(%0)\n\t" // subtraction here as we are darkening image
: : "r"(data) );
data += 4;
}
end += rem;
while ( data != end ) {
__asm__ __volatile__(
"movd (%0), %%mm0\n\t"
"punpcklbw %%mm7, %%mm0\n\t"
"movq %%mm0, %%mm3\n\t"
"pmullw %%mm6, %%mm0\n\t"
"psrlw $8, %%mm0\n\t"
"psubusw %%mm0, %%mm3\n\t"
"packuswb %%mm3, %%mm3\n\t"
"movd %%mm3, (%0)\n\t"
: : "r"(data) );
data++;
}
}
__asm__ __volatile__("emms"); // clear mmx state
}
else
#endif // USE_MMX_INLINE_ASM
{
unsigned char *segTbl = new unsigned char[segColors];
int tmp;
if(brighten){ // keep overflow check out of loops
for(int i=0; i < segColors; ++i){
tmp = (int)(i*percent);
if(tmp > 255)
tmp = 255;
segTbl[i] = tmp;
}
}
else{
for(int i=0; i < segColors; ++i){
tmp = (int)(i*percent);
if(tmp < 0)
tmp = 0;
segTbl[i] = tmp;
}
}
if(brighten){ // same here
for(int i=0; i < pixels; ++i){
int r = qRed(data[i]);
int g = qGreen(data[i]);
int b = qBlue(data[i]);
int a = qAlpha(data[i]);
r = r + segTbl[r] > 255 ? 255 : r + segTbl[r];
g = g + segTbl[g] > 255 ? 255 : g + segTbl[g];
b = b + segTbl[b] > 255 ? 255 : b + segTbl[b];
data[i] = qRgba(r, g, b,a);
INVERT(data[i]);
}
}
else{
for(int i=0; i < pixels; ++i){
int r = qRed(data[i]);
int g = qGreen(data[i]);
int b = qBlue(data[i]);
int a = qAlpha(data[i]);
r = r - segTbl[r] < 0 ? 0 : r - segTbl[r];
g = g - segTbl[g] < 0 ? 0 : g - segTbl[g];
b = b - segTbl[b] < 0 ? 0 : b - segTbl[b];
data[i] = qRgba(r, g, b, a);
INVERT(data[i]);
}
}
delete [] segTbl;
}
return image;
}
QImage& KImageEffect::channelIntensity(QImage &image, float percent,
RGBComponent channel)
{
if (image.width() == 0 || image.height() == 0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::channelIntensity : invalid image\n";
#endif
return image;
}
int segColors = image.depth() > 8 ? 256 : image.numColors();
unsigned char *segTbl = new unsigned char[segColors];
int pixels = image.depth() > 8 ? image.width()*image.height() :
image.numColors();
unsigned int *data = image.depth() > 8 ? (unsigned int *)image.bits() :
(unsigned int *)image.colorTable();
bool brighten = (percent >= 0);
if(percent < 0)
percent = -percent;
if(brighten){ // keep overflow check out of loops
for(int i=0; i < segColors; ++i){
int tmp = (int)(i*percent);
if(tmp > 255)
tmp = 255;
segTbl[i] = tmp;
}
}
else{
for(int i=0; i < segColors; ++i){
int tmp = (int)(i*percent);
if(tmp < 0)
tmp = 0;
segTbl[i] = tmp;
}
}
if(brighten){ // same here
if(channel == Red){ // and here ;-)
for(int i=0; i < pixels; ++i){
int c = qRed(data[i]);
c = c + segTbl[c] > 255 ? 255 : c + segTbl[c];
data[i] = qRgba(c, qGreen(data[i]), qBlue(data[i]), qAlpha(data[i]));
INVERT(data[i]);
}
}
else if(channel == Green){
for(int i=0; i < pixels; ++i){
int c = qGreen(data[i]);
c = c + segTbl[c] > 255 ? 255 : c + segTbl[c];
data[i] = qRgba(qRed(data[i]), c, qBlue(data[i]), qAlpha(data[i]));
INVERT(data[i]);
}
}
else{
for(int i=0; i < pixels; ++i){
int c = qBlue(data[i]);
c = c + segTbl[c] > 255 ? 255 : c + segTbl[c];
data[i] = qRgba(qRed(data[i]), qGreen(data[i]), c, qAlpha(data[i]));
INVERT(data[i]);
}
}
}
else{
if(channel == Red){
for(int i=0; i < pixels; ++i){
int c = qRed(data[i]);
c = c - segTbl[c] < 0 ? 0 : c - segTbl[c];
data[i] = qRgba(c, qGreen(data[i]), qBlue(data[i]), qAlpha(data[i]));
INVERT(data[i]);
}
}
else if(channel == Green){
for(int i=0; i < pixels; ++i){
int c = qGreen(data[i]);
c = c - segTbl[c] < 0 ? 0 : c - segTbl[c];
data[i] = qRgba(qRed(data[i]), c, qBlue(data[i]), qAlpha(data[i]));
INVERT(data[i]);
}
}
else{
for(int i=0; i < pixels; ++i){
int c = qBlue(data[i]);
c = c - segTbl[c] < 0 ? 0 : c - segTbl[c];
data[i] = qRgba(qRed(data[i]), qGreen(data[i]), c, qAlpha(data[i]));
INVERT(data[i]);
}
}
}
delete [] segTbl;
return image;
}
#if 0
// Modulate an image with an RBG channel of another image
//
QImage& KImageEffect::modulate(QImage &image, QImage &modImage, bool reverse,
ModulationType type, int factor, RGBComponent channel)
{
if (image.width() == 0 || image.height() == 0 ||
modImage.width() == 0 || modImage.height() == 0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::modulate : invalid image\n";
#endif
return image;
}
int r, g, b, h, s, v, a;
QColor clr;
int mod=0;
unsigned int x1, x2, y1, y2;
register int x, y;
// for image, we handle only depth 32
if (image.depth()<32) image = image.convertDepth(32);
// for modImage, we handle depth 8 and 32
if (modImage.depth()<8) modImage = modImage.convertDepth(8);
unsigned int *colorTable2 = (modImage.depth()==8) ?
modImage.colorTable():0;
unsigned int *data1, *data2;
unsigned char *data2b;
unsigned int color1, color2;
x1 = image.width(); y1 = image.height();
x2 = modImage.width(); y2 = modImage.height();
for (y = 0; y < (int)y1; y++) {
data1 = (unsigned int *) image.scanLine(y);
data2 = (unsigned int *) modImage.scanLine( y%y2 );
data2b = (unsigned char *) modImage.scanLine( y%y2 );
x=0;
while(x < (int)x1) {
color2 = (colorTable2) ? colorTable2[*data2b] : *data2;
if (reverse) {
color1 = color2;
color2 = *data1;
}
else
color1 = *data1;
if (type == Intensity || type == Contrast) {
r = qRed(color1);
g = qGreen(color1);
b = qBlue(color1);
if (channel != All) {
mod = (channel == Red) ? qRed(color2) :
(channel == Green) ? qGreen(color2) :
(channel == Blue) ? qBlue(color2) :
(channel == Gray) ? qGray(color2) : 0;
mod = mod*factor/50;
}
if (type == Intensity) {
if (channel == All) {
r += r * factor/50 * qRed(color2)/256;
g += g * factor/50 * qGreen(color2)/256;
b += b * factor/50 * qBlue(color2)/256;
}
else {
r += r * mod/256;
g += g * mod/256;
b += b * mod/256;
}
}
else { // Contrast
if (channel == All) {
r += (r-128) * factor/50 * qRed(color2)/128;
g += (g-128) * factor/50 * qGreen(color2)/128;
b += (b-128) * factor/50 * qBlue(color2)/128;
}
else {
r += (r-128) * mod/128;
g += (g-128) * mod/128;
b += (b-128) * mod/128;
}
}
if (r<0) r=0; if (r>255) r=255;
if (g<0) g=0; if (g>255) g=255;
if (b<0) b=0; if (b>255) b=255;
a = qAlpha(*data1);
*data1 = qRgba(r, g, b, a);
}
else if (type == Saturation || type == HueShift) {
clr.setRgb(color1);
clr.hsv(&h, &s, &v);
mod = (channel == Red) ? qRed(color2) :
(channel == Green) ? qGreen(color2) :
(channel == Blue) ? qBlue(color2) :
(channel == Gray) ? qGray(color2) : 0;
mod = mod*factor/50;
if (type == Saturation) {
s -= s * mod/256;
if (s<0) s=0; if (s>255) s=255;
}
else { // HueShift
h += mod;
while(h<0) h+=360;
h %= 360;
}
clr.setHsv(h, s, v);
a = qAlpha(*data1);
*data1 = clr.rgb() | ((uint)(a & 0xff) << 24);
}
data1++; data2++; data2b++; x++;
if ( (x%x2) ==0) { data2 -= x2; data2b -= x2; }
}
}
return image;
}
//======================================================================
//
// Blend effects
//
//======================================================================
// Nice and fast direct pixel manipulation
QImage& KImageEffect::blend(const QColor& clr, QImage& dst, float opacity)
{
if (dst.width() <= 0 || dst.height() <= 0)
return dst;
if (opacity < 0.0 || opacity > 1.0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::blend : invalid opacity. Range [0, 1]\n";
#endif
return dst;
}
int depth = dst.depth();
if (depth != 32)
dst = dst.convertDepth(32);
int pixels = dst.width() * dst.height();
#ifdef USE_SSE2_INLINE_ASM
if ( KCPUInfo::haveExtension( KCPUInfo::IntelSSE2 ) && pixels > 16 ) {
Q_UINT16 alpha = Q_UINT16( ( 1.0 - opacity ) * 256.0 );
KIE8Pack packedalpha = { { alpha, alpha, alpha, 256,
alpha, alpha, alpha, 256 } };
Q_UINT16 red = Q_UINT16( clr.red() * 256 * opacity );
Q_UINT16 green = Q_UINT16( clr.green() * 256 * opacity );
Q_UINT16 blue = Q_UINT16( clr.blue() * 256 * opacity );
KIE8Pack packedcolor = { { blue, green, red, 0,
blue, green, red, 0 } };
// Prepare the XMM5, XMM6 and XMM7 registers for unpacking and blending
__asm__ __volatile__(
"pxor %%xmm7, %%xmm7\n\t" // Zero out XMM7 for unpacking
"movdqu (%0), %%xmm6\n\t" // Set up (1 - alpha) * 256 in XMM6
"movdqu (%1), %%xmm5\n\t" // Set up color * alpha * 256 in XMM5
: : "r"(&packedalpha), "r"(&packedcolor), "m"(packedcolor), "m"(packedalpha) );
Q_UINT32 *data = reinterpret_cast<Q_UINT32*>( dst.bits() );
// Check how many pixels we need to process to achieve 16 byte alignment
int offset = (16 - (Q_UINT32( data ) & 0x0f)) / 4;
// The main loop processes 8 pixels / iteration
int remainder = (pixels - offset) % 8;
pixels -= remainder;
// Alignment loop
for ( int i = 0; i < offset; i++ ) {
__asm__ __volatile__(
"movd (%0,%1,4), %%xmm0\n\t" // Load one pixel to XMM1
"punpcklbw %%xmm7, %%xmm0\n\t" // Unpack the pixel
"pmullw %%xmm6, %%xmm0\n\t" // Multiply the pixel with (1 - alpha) * 256
"paddw %%xmm5, %%xmm0\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%xmm0\n\t" // Divide by 256
"packuswb %%xmm1, %%xmm0\n\t" // Pack the pixel to a dword
"movd %%xmm0, (%0,%1,4)\n\t" // Write the pixel to the image
: : "r"(data), "r"(i) );
}
// Main loop
for ( int i = offset; i < pixels; i += 8 ) {
__asm__ __volatile(
// Load 8 pixels to XMM registers 1 - 4
"movq (%0,%1,4), %%xmm0\n\t" // Load pixels 1 and 2 to XMM1
"movq 8(%0,%1,4), %%xmm1\n\t" // Load pixels 3 and 4 to XMM2
"movq 16(%0,%1,4), %%xmm2\n\t" // Load pixels 5 and 6 to XMM3
"movq 24(%0,%1,4), %%xmm3\n\t" // Load pixels 7 and 8 to XMM4
// Prefetch the pixels for next iteration
"prefetchnta 32(%0,%1,4) \n\t"
// Blend pixels 1 and 2
"punpcklbw %%xmm7, %%xmm0\n\t" // Unpack the pixels
"pmullw %%xmm6, %%xmm0\n\t" // Multiply the pixels with (1 - alpha) * 256
"paddw %%xmm5, %%xmm0\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%xmm0\n\t" // Divide by 256
// Blend pixels 3 and 4
"punpcklbw %%xmm7, %%xmm1\n\t" // Unpack the pixels
"pmullw %%xmm6, %%xmm1\n\t" // Multiply the pixels with (1 - alpha) * 256
"paddw %%xmm5, %%xmm1\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%xmm1\n\t" // Divide by 256
// Blend pixels 5 and 6
"punpcklbw %%xmm7, %%xmm2\n\t" // Unpack the pixels
"pmullw %%xmm6, %%xmm2\n\t" // Multiply the pixels with (1 - alpha) * 256
"paddw %%xmm5, %%xmm2\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%xmm2\n\t" // Divide by 256
// Blend pixels 7 and 8
"punpcklbw %%xmm7, %%xmm3\n\t" // Unpack the pixels
"pmullw %%xmm6, %%xmm3\n\t" // Multiply the pixels with (1 - alpha) * 256
"paddw %%xmm5, %%xmm3\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%xmm3\n\t" // Divide by 256
// Pack the pixels into 2 double quadwords
"packuswb %%xmm1, %%xmm0\n\t" // Pack pixels 1 - 4 to a double qword
"packuswb %%xmm3, %%xmm2\n\t" // Pack pixles 5 - 8 to a double qword
// Write the pixels back to the image
"movdqa %%xmm0, (%0,%1,4)\n\t" // Store pixels 1 - 4
"movdqa %%xmm2, 16(%0,%1,4)\n\t" // Store pixels 5 - 8
: : "r"(data), "r"(i) );
}
// Cleanup loop
for ( int i = pixels; i < pixels + remainder; i++ ) {
__asm__ __volatile__(
"movd (%0,%1,4), %%xmm0\n\t" // Load one pixel to XMM1
"punpcklbw %%xmm7, %%xmm0\n\t" // Unpack the pixel
"pmullw %%xmm6, %%xmm0\n\t" // Multiply the pixel with (1 - alpha) * 256
"paddw %%xmm5, %%xmm0\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%xmm0\n\t" // Divide by 256
"packuswb %%xmm1, %%xmm0\n\t" // Pack the pixel to a dword
"movd %%xmm0, (%0,%1,4)\n\t" // Write the pixel to the image
: : "r"(data), "r"(i) );
}
} else
#endif
#ifdef USE_MMX_INLINE_ASM
if ( KCPUInfo::haveExtension( KCPUInfo::IntelMMX ) && pixels > 1 ) {
Q_UINT16 alpha = Q_UINT16( ( 1.0 - opacity ) * 256.0 );
KIE4Pack packedalpha = { { alpha, alpha, alpha, 256 } };
Q_UINT16 red = Q_UINT16( clr.red() * 256 * opacity );
Q_UINT16 green = Q_UINT16( clr.green() * 256 * opacity );
Q_UINT16 blue = Q_UINT16( clr.blue() * 256 * opacity );
KIE4Pack packedcolor = { { blue, green, red, 0 } };
__asm__ __volatile__(
"pxor %%mm7, %%mm7\n\t" // Zero out MM7 for unpacking
"movq (%0), %%mm6\n\t" // Set up (1 - alpha) * 256 in MM6
"movq (%1), %%mm5\n\t" // Set up color * alpha * 256 in MM5
: : "r"(&packedalpha), "r"(&packedcolor), "m"(packedcolor), "m"(packedalpha) );
Q_UINT32 *data = reinterpret_cast<Q_UINT32*>( dst.bits() );
// The main loop processes 4 pixels / iteration
int remainder = pixels % 4;
pixels -= remainder;
// Main loop
for ( int i = 0; i < pixels; i += 4 ) {
__asm__ __volatile__(
// Load 4 pixels to MM registers 1 - 4
"movd (%0,%1,4), %%mm0\n\t" // Load the 1st pixel to MM0
"movd 4(%0,%1,4), %%mm1\n\t" // Load the 2nd pixel to MM1
"movd 8(%0,%1,4), %%mm2\n\t" // Load the 3rd pixel to MM2
"movd 12(%0,%1,4), %%mm3\n\t" // Load the 4th pixel to MM3
// Blend the first pixel
"punpcklbw %%mm7, %%mm0\n\t" // Unpack the pixel
"pmullw %%mm6, %%mm0\n\t" // Multiply the pixel with (1 - alpha) * 256
"paddw %%mm5, %%mm0\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%mm0\n\t" // Divide by 256
// Blend the second pixel
"punpcklbw %%mm7, %%mm1\n\t" // Unpack the pixel
"pmullw %%mm6, %%mm1\n\t" // Multiply the pixel with (1 - alpha) * 256
"paddw %%mm5, %%mm1\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%mm1\n\t" // Divide by 256
// Blend the third pixel
"punpcklbw %%mm7, %%mm2\n\t" // Unpack the pixel
"pmullw %%mm6, %%mm2\n\t" // Multiply the pixel with (1 - alpha) * 256
"paddw %%mm5, %%mm2\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%mm2\n\t" // Divide by 256
// Blend the fourth pixel
"punpcklbw %%mm7, %%mm3\n\t" // Unpack the pixel
"pmullw %%mm6, %%mm3\n\t" // Multiply the pixel with (1 - alpha) * 256
"paddw %%mm5, %%mm3\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%mm3\n\t" // Divide by 256
// Pack the pixels into 2 quadwords
"packuswb %%mm1, %%mm0\n\t" // Pack pixels 1 and 2 to a qword
"packuswb %%mm3, %%mm2\n\t" // Pack pixels 3 and 4 to a qword
// Write the pixels back to the image
"movq %%mm0, (%0,%1,4)\n\t" // Store pixels 1 and 2
"movq %%mm2, 8(%0,%1,4)\n\t" // Store pixels 3 and 4
: : "r"(data), "r"(i) );
}
// Cleanup loop
for ( int i = pixels; i < pixels + remainder; i++ ) {
__asm__ __volatile__(
"movd (%0,%1,4), %%mm0\n\t" // Load one pixel to MM1
"punpcklbw %%mm7, %%mm0\n\t" // Unpack the pixel
"pmullw %%mm6, %%mm0\n\t" // Multiply the pixel with 1 - alpha * 256
"paddw %%mm5, %%mm0\n\t" // Add color * alpha * 256 to the result
"psrlw $8, %%mm0\n\t" // Divide by 256
"packuswb %%mm0, %%mm0\n\t" // Pack the pixel to a dword
"movd %%mm0, (%0,%1,4)\n\t" // Write the pixel to the image
: : "r"(data), "r"(i) );
}
// Empty the MMX state
__asm__ __volatile__("emms");
} else
#endif // USE_MMX_INLINE_ASM
{
int rcol, gcol, bcol;
clr.rgb(&rcol, &gcol, &bcol);
#ifdef WORDS_BIGENDIAN // ARGB (skip alpha)
register unsigned char *data = (unsigned char *)dst.bits() + 1;
#else // BGRA
register unsigned char *data = (unsigned char *)dst.bits();
#endif
for (register int i=0; i<pixels; i++)
{
#ifdef WORDS_BIGENDIAN
*(data++) += (unsigned char)((rcol - *data) * opacity);
*(data++) += (unsigned char)((gcol - *data) * opacity);
*(data++) += (unsigned char)((bcol - *data) * opacity);
#else
*(data++) += (unsigned char)((bcol - *data) * opacity);
*(data++) += (unsigned char)((gcol - *data) * opacity);
*(data++) += (unsigned char)((rcol - *data) * opacity);
#endif
data++; // skip alpha
}
}
return dst;
}
// Nice and fast direct pixel manipulation
QImage& KImageEffect::blend(QImage& src, QImage& dst, float opacity)
{
if (src.width() <= 0 || src.height() <= 0)
return dst;
if (dst.width() <= 0 || dst.height() <= 0)
return dst;
if (src.width() != dst.width() || src.height() != dst.height()) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::blend : src and destination images are not the same size\n";
#endif
return dst;
}
if (opacity < 0.0 || opacity > 1.0) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::blend : invalid opacity. Range [0, 1]\n";
#endif
return dst;
}
if (src.depth() != 32) src = src.convertDepth(32);
if (dst.depth() != 32) dst = dst.convertDepth(32);
int pixels = src.width() * src.height();
#ifdef USE_SSE2_INLINE_ASM
if ( KCPUInfo::haveExtension( KCPUInfo::IntelSSE2 ) && pixels > 16 ) {
Q_UINT16 alpha = Q_UINT16( opacity * 256.0 );
KIE8Pack packedalpha = { { alpha, alpha, alpha, 0,
alpha, alpha, alpha, 0 } };
// Prepare the XMM6 and XMM7 registers for unpacking and blending
__asm__ __volatile__(
"pxor %%xmm7, %%xmm7\n\t" // Zero out XMM7 for unpacking
"movdqu (%0), %%xmm6\n\t" // Set up alpha * 256 in XMM6
: : "r"(&packedalpha), "m"(packedalpha) );
Q_UINT32 *data1 = reinterpret_cast<Q_UINT32*>( src.bits() );
Q_UINT32 *data2 = reinterpret_cast<Q_UINT32*>( dst.bits() );
// Check how many pixels we need to process to achieve 16 byte alignment
int offset = (16 - (Q_UINT32( data2 ) & 0x0f)) / 4;
// The main loop processes 4 pixels / iteration
int remainder = (pixels - offset) % 4;
pixels -= remainder;
// Alignment loop
for ( int i = 0; i < offset; i++ ) {
__asm__ __volatile__(
"movd (%1,%2,4), %%xmm1\n\t" // Load one dst pixel to XMM1
"punpcklbw %%xmm7, %%xmm1\n\t" // Unpack the pixel
"movd (%0,%2,4), %%xmm0\n\t" // Load one src pixel to XMM0
"punpcklbw %%xmm7, %%xmm0\n\t" // Unpack the pixel
"psubw %%xmm1, %%xmm0\n\t" // Subtract dst from src
"pmullw %%xmm6, %%xmm0\n\t" // Multiply the result with alpha * 256
"psllw $8, %%xmm1\n\t" // Multiply dst with 256
"paddw %%xmm1, %%xmm0\n\t" // Add dst to result
"psrlw $8, %%xmm0\n\t" // Divide by 256
"packuswb %%xmm1, %%xmm0\n\t" // Pack the pixel to a dword
"movd %%xmm0, (%1,%2,4)\n\t" // Write the pixel to the image
: : "r"(data1), "r"(data2), "r"(i) );
}
// Main loop
for ( int i = offset; i < pixels; i += 4 ) {
__asm__ __volatile__(
// Load 4 src pixels to XMM0 and XMM2 and 4 dst pixels to XMM1 and XMM3
"movq (%0,%2,4), %%xmm0\n\t" // Load two src pixels to XMM0
"movq (%1,%2,4), %%xmm1\n\t" // Load two dst pixels to XMM1
"movq 8(%0,%2,4), %%xmm2\n\t" // Load two src pixels to XMM2
"movq 8(%1,%2,4), %%xmm3\n\t" // Load two dst pixels to XMM3
// Prefetch the pixels for the iteration after the next one
"prefetchnta 32(%0,%2,4) \n\t"
"prefetchnta 32(%1,%2,4) \n\t"
// Blend the first two pixels
"punpcklbw %%xmm7, %%xmm1\n\t" // Unpack the dst pixels
"punpcklbw %%xmm7, %%xmm0\n\t" // Unpack the src pixels
"psubw %%xmm1, %%xmm0\n\t" // Subtract dst from src
"pmullw %%xmm6, %%xmm0\n\t" // Multiply the result with alpha * 256
"psllw $8, %%xmm1\n\t" // Multiply dst with 256
"paddw %%xmm1, %%xmm0\n\t" // Add dst to the result
"psrlw $8, %%xmm0\n\t" // Divide by 256
// Blend the next two pixels
"punpcklbw %%xmm7, %%xmm3\n\t" // Unpack the dst pixels
"punpcklbw %%xmm7, %%xmm2\n\t" // Unpack the src pixels
"psubw %%xmm3, %%xmm2\n\t" // Subtract dst from src
"pmullw %%xmm6, %%xmm2\n\t" // Multiply the result with alpha * 256
"psllw $8, %%xmm3\n\t" // Multiply dst with 256
"paddw %%xmm3, %%xmm2\n\t" // Add dst to the result
"psrlw $8, %%xmm2\n\t" // Divide by 256
// Write the pixels back to the image
"packuswb %%xmm2, %%xmm0\n\t" // Pack the pixels to a double qword
"movdqa %%xmm0, (%1,%2,4)\n\t" // Store the pixels
: : "r"(data1), "r"(data2), "r"(i) );
}
// Cleanup loop
for ( int i = pixels; i < pixels + remainder; i++ ) {
__asm__ __volatile__(
"movd (%1,%2,4), %%xmm1\n\t" // Load one dst pixel to XMM1
"punpcklbw %%xmm7, %%xmm1\n\t" // Unpack the pixel
"movd (%0,%2,4), %%xmm0\n\t" // Load one src pixel to XMM0
"punpcklbw %%xmm7, %%xmm0\n\t" // Unpack the pixel
"psubw %%xmm1, %%xmm0\n\t" // Subtract dst from src
"pmullw %%xmm6, %%xmm0\n\t" // Multiply the result with alpha * 256
"psllw $8, %%xmm1\n\t" // Multiply dst with 256
"paddw %%xmm1, %%xmm0\n\t" // Add dst to result
"psrlw $8, %%xmm0\n\t" // Divide by 256
"packuswb %%xmm1, %%xmm0\n\t" // Pack the pixel to a dword
"movd %%xmm0, (%1,%2,4)\n\t" // Write the pixel to the image
: : "r"(data1), "r"(data2), "r"(i) );
}
} else
#endif // USE_SSE2_INLINE_ASM
#ifdef USE_MMX_INLINE_ASM
if ( KCPUInfo::haveExtension( KCPUInfo::IntelMMX ) && pixels > 1 ) {
Q_UINT16 alpha = Q_UINT16( opacity * 256.0 );
KIE4Pack packedalpha = { { alpha, alpha, alpha, 0 } };
// Prepare the MM6 and MM7 registers for blending and unpacking
__asm__ __volatile__(
"pxor %%mm7, %%mm7\n\t" // Zero out MM7 for unpacking
"movq (%0), %%mm6\n\t" // Set up alpha * 256 in MM6
: : "r"(&packedalpha), "m"(packedalpha) );
Q_UINT32 *data1 = reinterpret_cast<Q_UINT32*>( src.bits() );
Q_UINT32 *data2 = reinterpret_cast<Q_UINT32*>( dst.bits() );
// The main loop processes 2 pixels / iteration
int remainder = pixels % 2;
pixels -= remainder;
// Main loop
for ( int i = 0; i < pixels; i += 2 ) {
__asm__ __volatile__(
// Load 2 src pixels to MM0 and MM2 and 2 dst pixels to MM1 and MM3
"movd (%0,%2,4), %%mm0\n\t" // Load the 1st src pixel to MM0
"movd (%1,%2,4), %%mm1\n\t" // Load the 1st dst pixel to MM1
"movd 4(%0,%2,4), %%mm2\n\t" // Load the 2nd src pixel to MM2
"movd 4(%1,%2,4), %%mm3\n\t" // Load the 2nd dst pixel to MM3
// Blend the first pixel
"punpcklbw %%mm7, %%mm0\n\t" // Unpack the src pixel
"punpcklbw %%mm7, %%mm1\n\t" // Unpack the dst pixel
"psubw %%mm1, %%mm0\n\t" // Subtract dst from src
"pmullw %%mm6, %%mm0\n\t" // Multiply the result with alpha * 256
"psllw $8, %%mm1\n\t" // Multiply dst with 256
"paddw %%mm1, %%mm0\n\t" // Add dst to the result
"psrlw $8, %%mm0\n\t" // Divide by 256
// Blend the second pixel
"punpcklbw %%mm7, %%mm2\n\t" // Unpack the src pixel
"punpcklbw %%mm7, %%mm3\n\t" // Unpack the dst pixel
"psubw %%mm3, %%mm2\n\t" // Subtract dst from src
"pmullw %%mm6, %%mm2\n\t" // Multiply the result with alpha * 256
"psllw $8, %%mm3\n\t" // Multiply dst with 256
"paddw %%mm3, %%mm2\n\t" // Add dst to the result
"psrlw $8, %%mm2\n\t" // Divide by 256
// Write the pixels back to the image
"packuswb %%mm2, %%mm0\n\t" // Pack the pixels to a qword
"movq %%mm0, (%1,%2,4)\n\t" // Store the pixels
: : "r"(data1), "r"(data2), "r"(i) );
}
// Blend the remaining pixel (if there is one)
if ( remainder ) {
__asm__ __volatile__(
"movd (%0), %%mm0\n\t" // Load one src pixel to MM0
"punpcklbw %%mm7, %%mm0\n\t" // Unpack the src pixel
"movd (%1), %%mm1\n\t" // Load one dst pixel to MM1
"punpcklbw %%mm7, %%mm1\n\t" // Unpack the dst pixel
"psubw %%mm1, %%mm0\n\t" // Subtract dst from src
"pmullw %%mm6, %%mm0\n\t" // Multiply the result with alpha * 256
"psllw $8, %%mm1\n\t" // Multiply dst with 256
"paddw %%mm1, %%mm0\n\t" // Add dst to result
"psrlw $8, %%mm0\n\t" // Divide by 256
"packuswb %%mm0, %%mm0\n\t" // Pack the pixel to a dword
"movd %%mm0, (%1)\n\t" // Write the pixel to the image
: : "r"(data1 + pixels), "r"(data2 + pixels) );
}
// Empty the MMX state
__asm__ __volatile__("emms");
} else
#endif // USE_MMX_INLINE_ASM
{
#ifdef WORDS_BIGENDIAN // ARGB (skip alpha)
register unsigned char *data1 = (unsigned char *)dst.bits() + 1;
register unsigned char *data2 = (unsigned char *)src.bits() + 1;
#else // BGRA
register unsigned char *data1 = (unsigned char *)dst.bits();
register unsigned char *data2 = (unsigned char *)src.bits();
#endif
for (register int i=0; i<pixels; i++)
{
#ifdef WORDS_BIGENDIAN
*(data1++) += (unsigned char)((*(data2++) - *data1) * opacity);
*(data1++) += (unsigned char)((*(data2++) - *data1) * opacity);
*(data1++) += (unsigned char)((*(data2++) - *data1) * opacity);
#else
*(data1++) += (unsigned char)((*(data2++) - *data1) * opacity);
*(data1++) += (unsigned char)((*(data2++) - *data1) * opacity);
*(data1++) += (unsigned char)((*(data2++) - *data1) * opacity);
#endif
data1++; // skip alpha
data2++;
}
}
return dst;
}
QImage& KImageEffect::blend(QImage &image, float initial_intensity,
const QColor &bgnd, GradientType eff,
bool anti_dir)
{
if (image.width() == 0 || image.height() == 0 || image.depth()!=32 ) {
#ifndef NDEBUG
std::cerr << "WARNING: KImageEffect::blend : invalid image\n";
#endif
return image;
}
int r_bgnd = bgnd.red(), g_bgnd = bgnd.green(), b_bgnd = bgnd.blue();
int r, g, b;
int ind;
unsigned int xi, xf, yi, yf;
unsigned int a;
// check the boundaries of the initial intesity param
float unaffected = 1;
if (initial_intensity > 1) initial_intensity = 1;
if (initial_intensity < -1) initial_intensity = -1;
if (initial_intensity < 0) {
unaffected = 1. + initial_intensity;
initial_intensity = 0;
}
float intensity = initial_intensity;
float var = 1. - initial_intensity;
if (anti_dir) {
initial_intensity = intensity = 1.;
var = -var;
}
register int x, y;
unsigned int *data = (unsigned int *)image.bits();
int image_width = image.width(); //Those can't change
int image_height = image.height();
if( eff == VerticalGradient || eff == HorizontalGradient ) {
// set the image domain to apply the effect to
xi = 0, xf = image_width;
yi = 0, yf = image_height;
if (eff == VerticalGradient) {
if (anti_dir) yf = (int)(image_height * unaffected);
else yi = (int)(image_height * (1 - unaffected));
}
else {
if (anti_dir) xf = (int)(image_width * unaffected);
else xi = (int)(image_height * (1 - unaffected));
}
var /= (eff == VerticalGradient?yf-yi:xf-xi);
int ind_base;
for (y = yi; y < (int)yf; y++) {
intensity = eff == VerticalGradient? intensity + var :
initial_intensity;
ind_base = image_width * y ;
for (x = xi; x < (int)xf ; x++) {
if (eff == HorizontalGradient) intensity += var;
ind = x + ind_base;
r = qRed (data[ind]) + (int)(intensity *
(r_bgnd - qRed (data[ind])));
g = qGreen(data[ind]) + (int)(intensity *
(g_bgnd - qGreen(data[ind])));
b = qBlue (data[ind]) + (int)(intensity *
(b_bgnd - qBlue (data[ind])));
if (r > 255) r = 255; if (r < 0 ) r = 0;
if (g > 255) g = 255; if (g < 0 ) g = 0;
if (b > 255) b = 255; if (b < 0 ) b = 0;
a = qAlpha(data[ind]);
data[ind] = qRgba(r, g, b, a);
}
}
}
else if (eff == DiagonalGradient || eff == CrossDiagonalGradient) {
float xvar = var / 2 / image_width; // / unaffected;
float yvar = var / 2 / image_height; // / unaffected;
float tmp;
for (x = 0; x < image_width ; x++) {
tmp = xvar * (eff == DiagonalGradient? x : image.width()-x-1);
ind = x;
for (y = 0; y < image_height ; y++) {
intensity = initial_intensity + tmp + yvar * y;
r = qRed (data[ind]) + (int)(intensity *
(r_bgnd - qRed (data[ind])));
g = qGreen(data[ind]) + (int)(intensity *
(g_bgnd - qGreen(data[ind])));
b = qBlue (data[ind]) + (int)(intensity *
(b_bgnd - qBlue (data[ind])));
if (r > 255) r = 255; if (r < 0 ) r = 0;
if (g > 255) g = 255; if (g < 0 ) g = 0;
if (b > 255) b = 255; if (b < 0 ) b = 0;
a = qAlpha(data[ind]);
data[ind] = qRgba(r, g, b, a);
ind += image_width;
}
}
}
else if (eff == RectangleGradient || eff == EllipticGradient) {
float xvar;
float yvar;
for (x = 0; x < image_width / 2 + image_width % 2; x++) {
xvar = var / image_width * (image_width - x*2/unaffected-1);
for (y = 0; y < image_height / 2 + image_height % 2; y++) {
yvar = var / image_height * (image_height - y*2/unaffected -1);
if (eff == RectangleGradient)
intensity = initial_intensity + QMAX(xvar, yvar);
else
intensity = initial_intensity + sqrt(xvar * xvar + yvar * yvar);
if (intensity > 1) intensity = 1;
if (intensity < 0) intensity = 0;
//NW
ind = x + image_width * y ;
r = qRed (data[ind]) + (int)(intensity *
(r_bgnd - qRed (data[ind])));
g = qGreen(data[ind]) + (int)(intensity *
(g_bgnd - qGreen(data[ind])));
b = qBlue (data[ind]) + (int)(intensity *
(b_bgnd - qBlue (data[ind])));
if (r > 255) r = 255; if (r < 0 ) r = 0;
if (g > 255) g = 255; if (g < 0 ) g = 0;
if (b > 255) b = 255; if (b < 0 ) b = 0;
a = qAlpha(data[ind]);
data[ind] = qRgba(r, g, b, a);
//NE
ind = image_width - x - 1 + image_width * y ;
r = qRed (data[ind]) + (int)(intensity *
(r_bgnd - qRed (data[ind])));
g = qGreen(data[ind]) + (int)(intensity *
(g_bgnd - qGreen(data[ind])));
b = qBlue (data[ind]) + (int)(intensity *
(b_bgnd - qBlue (data[ind])));
if (r > 255) r = 255; if (r < 0 ) r = 0;
if (g > 255) g = 255; if (g < 0 ) g = 0;
if (b > 255) b = 255; if (b < 0 ) b = 0;
a = qAlpha(data[ind]);
data[ind] = qRgba(r, g, b, a);
}
}
//CT loop is doubled because of stupid central row/column issue.
// other solution?
for (x = 0; x < image_width / 2; x++) {
xvar = var / image_width * (image_width - x*2/unaffected-1);
for (y = 0; y < image_height / 2; y++) {
yvar = var / image_height * (image_height - y*2/unaffected -1);
if (eff == RectangleGradient)
intensity = initial_intensity + QMAX(xvar, yvar);
else
intensity = initial_intensity + sqrt(xvar * xvar + yvar * yvar);
if (intensity > 1) intensity = 1;
if (intensity < 0) intensity = 0;
//SW
ind = x + image_width * (image_height - y -1) ;
r = qRed (data[ind]) + (int)(intensity *
(r_bgnd - qRed (data[ind])));
g = qGreen(data[ind]) + (int)(intensity *
(g_bgnd - qGreen(data[ind])));
b = qBlue (data[ind]) + (int)(intensity *
(b_bgnd - qBlue (data[ind])));
if (r > 255) r = 255; if (r < 0 ) r = 0;
if (g > 255) g = 255; if (g < 0 ) g = 0;
if (b > 255) b = 255; if (b < 0 ) b = 0;
a = qAlpha(data[ind]);
data[ind] = qRgba(r, g, b, a);
//SE
ind = image_width-x-1 + image_width * (image_height - y - 1) ;
r = qRed (data[ind]) + (int)(intensity *
(r_bgnd - qRed (data[ind])));
g = qGreen(data[ind]) + (int)(intensity *
(g_bgnd - qGreen(data[ind])));
b = qBlue (data[ind]) + (int)(intensity *
(b_bgnd - qBlue (data[ind])));
if (r > 255) r = 255; if (r < 0 ) r = 0;
if (g > 255) g = 255; if (g < 0 ) g = 0;
if (b > 255) b = 255; if (b < 0 ) b = 0;
a = qAlpha(data[ind]);
data[ind] = qRgba(r, g, b, a);
}
}
}
#ifndef NDEBUG
else std::cerr << "KImageEffect::blend effect not implemented" << std::endl;
#endif
return image;
}
// Not very efficient as we create a third big image...
//
QImage& KImageEffect::blend(QImage &image1, QImage &image2,
GradientType gt, int xf, int yf)
{
if (image1.width() == 0 || image1.height() == 0 ||
image2.width() == 0 || image2.height() == 0)
return image1;
QImage image3;
image3 = KImageEffect::unbalancedGradient(image1.size(),
QColor(0,0,0), QColor(255,255,255),
gt, xf, yf, 0);
return blend(image1,image2,image3, Red); // Channel to use is arbitrary
}
// Blend image2 into image1, using an RBG channel of blendImage
//
QImage& KImageEffect::blend(QImage &image1, QImage &image2,
QImage &blendImage, RGBComponent channel)
{
if (image1.width() == 0 || image1.height() == 0 ||
image2.width() == 0 || image2.height() == 0 ||
blendImage.width() == 0 || blendImage.height() == 0) {
#ifndef NDEBUG
std::cerr << "KImageEffect::blend effect invalid image" << std::endl;
#endif
return image1;
}
int r, g, b;
int ind1, ind2, ind3;
unsigned int x1, x2, x3, y1, y2, y3;
unsigned int a;
register int x, y;
// for image1 and image2, we only handle depth 32
if (image1.depth()<32) image1 = image1.convertDepth(32);
if (image2.depth()<32) image2 = image2.convertDepth(32);
// for blendImage, we handle depth 8 and 32
if (blendImage.depth()<8) blendImage = blendImage.convertDepth(8);
unsigned int *colorTable3 = (blendImage.depth()==8) ?
blendImage.colorTable():0;
unsigned int *data1 = (unsigned int *)image1.bits();
unsigned int *data2 = (unsigned int *)image2.bits();
unsigned int *data3 = (unsigned int *)blendImage.bits();
unsigned char *data3b = (unsigned char *)blendImage.bits();
unsigned int color3;
x1 = image1.width(); y1 = image1.height();
x2 = image2.width(); y2 = image2.height();
x3 = blendImage.width(); y3 = blendImage.height();
for (y = 0; y < (int)y1; y++) {
ind1 = x1*y;
ind2 = x2*(y%y2);
ind3 = x3*(y%y3);
x=0;
while(x < (int)x1) {
color3 = (colorTable3) ? colorTable3[data3b[ind3]] : data3[ind3];
a = (channel == Red) ? qRed(color3) :
(channel == Green) ? qGreen(color3) :
(channel == Blue) ? qBlue(color3) : qGray(color3);
r = (a*qRed(data1[ind1]) + (256-a)*qRed(data2[ind2]))/256;
g = (a*qGreen(data1[ind1]) + (256-a)*qGreen(data2[ind2]))/256;
b = (a*qBlue(data1[ind1]) + (256-a)*qBlue(data2[ind2]))/256;
a = qAlpha(data1[ind1]);
data1[ind1] = qRgba(r, g, b, a);
ind1++; ind2++; ind3++; x++;
if ( (x%x2) ==0) ind2 -= x2;
if ( (x%x3) ==0) ind3 -= x3;
}
}
return image1;
}
//======================================================================
//
// Hash effects
//
//======================================================================
unsigned int KImageEffect::lHash(unsigned int c)
{
unsigned char r = qRed(c), g = qGreen(c), b = qBlue(c), a = qAlpha(c);
unsigned char nr, ng, nb;
nr =(r >> 1) + (r >> 2); nr = nr > r ? 0 : nr;
ng =(g >> 1) + (g >> 2); ng = ng > g ? 0 : ng;
nb =(b >> 1) + (b >> 2); nb = nb > b ? 0 : nb;
return qRgba(nr, ng, nb, a);
}
// -----------------------------------------------------------------------------
unsigned int KImageEffect::uHash(unsigned int c)
{
unsigned char r = qRed(c), g = qGreen(c), b = qBlue(c), a = qAlpha(c);
unsigned char nr, ng, nb;
nr = r + (r >> 3); nr = nr < r ? ~0 : nr;
ng = g + (g >> 3); ng = ng < g ? ~0 : ng;
nb = b + (b >> 3); nb = nb < b ? ~0 : nb;
return qRgba(nr, ng, nb, a);
}
// -----------------------------------------------------------------------------
QImage& KImageEffect::hash(QImage &image, Lighting lite, unsigned int spacing)
{
if (image.width() == 0 || image.height() == 0) {
#ifndef NDEBUG
std::cerr << "KImageEffect::hash effect invalid image" << std::endl;
#endif
return image;
}
register int x, y;
unsigned int *data = (unsigned int *)image.bits();
unsigned int ind;
//CT no need to do it if not enough space
if ((lite == NorthLite ||
lite == SouthLite)&&
(unsigned)image.height() < 2+spacing) return image;
if ((lite == EastLite ||
lite == WestLite)&&
(unsigned)image.height() < 2+spacing) return image;
if (lite == NorthLite || lite == SouthLite) {
for (y = 0 ; y < image.height(); y = y + 2 + spacing) {
for (x = 0; x < image.width(); x++) {
ind = x + image.width() * y;
data[ind] = lite==NorthLite?uHash(data[ind]):lHash(data[ind]);
ind = ind + image.width();
data[ind] = lite==NorthLite?lHash(data[ind]):uHash(data[ind]);
}
}
}
else if (lite == EastLite || lite == WestLite) {
for (y = 0 ; y < image.height(); y++) {
for (x = 0; x < image.width(); x = x + 2 + spacing) {
ind = x + image.width() * y;
data[ind] = lite==EastLite?uHash(data[ind]):lHash(data[ind]);
ind++;
data[ind] = lite==EastLite?lHash(data[ind]):uHash(data[ind]);
}
}
}
else if (lite == NWLite || lite == SELite) {
for (y = 0 ; y < image.height(); y++) {
for (x = 0;
x < (int)(image.width() - ((y & 1)? 1 : 0) * spacing);
x = x + 2 + spacing) {
ind = x + image.width() * y + ((y & 1)? 1 : 0);
data[ind] = lite==NWLite?uHash(data[ind]):lHash(data[ind]);
ind++;
data[ind] = lite==NWLite?lHash(data[ind]):uHash(data[ind]);
}
}
}
else if (lite == SWLite || lite == NELite) {
for (y = 0 ; y < image.height(); y++) {
for (x = 0 + ((y & 1)? 1 : 0); x < image.width(); x = x + 2 + spacing) {
ind = x + image.width() * y - ((y & 1)? 1 : 0);
data[ind] = lite==SWLite?uHash(data[ind]):lHash(data[ind]);
ind++;
data[ind] = lite==SWLite?lHash(data[ind]):uHash(data[ind]);
}
}
}
return image;
}
#endif
//======================================================================
//
// Flatten effects
//
//======================================================================
QImage& KImageEffect::flatten(QImage &image, const QColor &ca,
const QColor &cb, int ncols)
{
if (image.width() == 0 || image.height() == 0)
return image;
// a bitmap is easy...
/*if (image.depth() == 1) {
image.setColor(0, ca.rgb());
image.setColor(1, cb.rgb());
return image;
}*/
int r1, r2, g1, g2, b1, b2;
int min = 0, max = 255;
if (image.inverted())
{
b1 = ca.red(); b2 = cb.red();
g1 = ca.green(); g2 = cb.green();
r1 = ca.blue(); r2 = cb.blue();
}
else
{
r1 = ca.red(); r2 = cb.red();
g1 = ca.green(); g2 = cb.green();
b1 = ca.blue(); b2 = cb.blue();
}
QRgb col;
// Get minimum and maximum greylevel.
/* if (image.numColors()) {
// pseudocolor
for (int i = 0; i < image.numColors(); i++) {
col = image.color(i);
int mean = (qRed(col) + qGreen(col) + qBlue(col)) / 3;
min = QMIN(min, mean);
max = QMAX(max, mean);
}
} else*/ {
// truecolor
for (int y=0; y < image.height(); y++)
for (int x=0; x < image.width(); x++) {
col = image.pixel(x, y);
int mean = (qRed(col) + qGreen(col) + qBlue(col)) / 3;
min = QMIN(min, mean);
max = QMAX(max, mean);
}
}
// Conversion factors
float sr = ((float) r2 - r1) / (max - min);
float sg = ((float) g2 - g1) / (max - min);
float sb = ((float) b2 - b1) / (max - min);
// Repaint the image
/* if (image.numColors()) {
for (int i=0; i < image.numColors(); i++) {
col = image.color(i);
int mean = (qRed(col) + qGreen(col) + qBlue(col)) / 3;
int r = (int) (sr * (mean - min) + r1 + 0.5);
int g = (int) (sg * (mean - min) + g1 + 0.5);
int b = (int) (sb * (mean - min) + b1 + 0.5);
image.setColor(i, qRgba(r, g, b, qAlpha(col)));
}
} else*/ {
for (int y=0; y < image.height(); y++)
for (int x=0; x < image.width(); x++) {
col = image.pixel(x, y);
//INVERT(col);
int mean = (qRed(col) + qGreen(col) + qBlue(col)) / 3;
int r = (int) (sr * (mean - min) + r1 + 0.5);
int g = (int) (sg * (mean - min) + g1 + 0.5);
int b = (int) (sb * (mean - min) + b1 + 0.5);
col = qRgba(r, g, b, qAlpha(col));
//INVERT(col);
image.setPixel(x, y, col);
}
}
/* // Dither if necessary
if ( (ncols <= 0) || ((image.numColors() != 0) && (image.numColors() <= ncols)))
return image;
if (ncols == 1) ncols++;
if (ncols > 256) ncols = 256;
QColor *pal = new QColor[ncols];
sr = ((float) r2 - r1) / (ncols - 1);
sg = ((float) g2 - g1) / (ncols - 1);
sb = ((float) b2 - b1) / (ncols - 1);
for (int i=0; i<ncols; i++)
pal[i] = QColor(r1 + int(sr*i), g1 + int(sg*i), b1 + int(sb*i));
dither(image, pal, ncols);
delete[] pal;*/
return image;
}
//======================================================================
//
// Fade effects
//
//======================================================================
QImage& KImageEffect::fade(QImage &image, float val, const QColor &color)
{
if (image.width() == 0 || image.height() == 0)
return image;
// We don't handle bitmaps
//if (image.depth() == 1)
//return image;
unsigned char tbl[256];
for (int i=0; i<256; i++)
tbl[i] = (int) (val * i + 0.5);
int red, green, blue;
if (image.inverted())
{
blue = color.red();
green = color.green();
red = color.blue();
}
else
{
red = color.red();
green = color.green();
blue = color.blue();
}
QRgb col;
int r, g, b, cr, cg, cb;
/*if (image.depth() <= 8) {
// pseudo color
for (int i=0; i<image.numColors(); i++) {
col = image.color(i);
cr = qRed(col); cg = qGreen(col); cb = qBlue(col);
if (cr > red)
r = cr - tbl[cr - red];
else
r = cr + tbl[red - cr];
if (cg > green)
g = cg - tbl[cg - green];
else
g = cg + tbl[green - cg];
if (cb > blue)
b = cb - tbl[cb - blue];
else
b = cb + tbl[blue - cb];
image.setColor(i, qRgba(r, g, b, qAlpha(col)));
}
} else*/ {
// truecolor
for (int y=0; y<image.height(); y++) {
QRgb *data = (QRgb *) image.scanLine(y);
for (int x=0; x<image.width(); x++) {
col = *data;
cr = qRed(col); cg = qGreen(col); cb = qBlue(col);
if (cr > red)
r = cr - tbl[cr - red];
else
r = cr + tbl[red - cr];
if (cg > green)
g = cg - tbl[cg - green];
else
g = cg + tbl[green - cg];
if (cb > blue)
b = cb - tbl[cb - blue];
else
b = cb + tbl[blue - cb];
*data++ = qRgba(r, g, b, qAlpha(col));
}
}
}
return image;
}
//======================================================================
//
// Color effects
//
//======================================================================
// This code is adapted from code (C) Rik Hemsley <rik@kde.org>
//
// The formula used (r + b + g) /3 is different from the qGray formula
// used by Qt. This is because our formula is much much faster. If,
// however, it turns out that this is producing sub-optimal images,
// then it will have to change (kurt)
//
// It does produce lower quality grayscale ;-) Use fast == true for the fast
// algorithm, false for the higher quality one (mosfet).
QImage& KImageEffect::toGray(QImage &img, bool fast)
{
if (img.width() == 0 || img.height() == 0)
return img;
/*
if(fast){
if (img.depth() == 32) {
register uchar * r(img.bits());
register uchar * g(img.bits() + 1);
register uchar * b(img.bits() + 2);
uchar * end(img.bits() + img.numBytes());
while (r != end) {
*r = *g = *b = (((*r + *g) >> 1) + *b) >> 1; // (r + b + g) / 3
r += 4;
g += 4;
b += 4;
}
}
else
{
for (int i = 0; i < img.numColors(); i++)
{
register uint r = qRed(img.color(i));
register uint g = qGreen(img.color(i));
register uint b = qBlue(img.color(i));
register uint gray = (((r + g) >> 1) + b) >> 1;
img.setColor(i, qRgba(gray, gray, gray, qAlpha(img.color(i))));
}
}
}
else*/{
int pixels = img.depth() > 8 ? img.width()*img.height() :
img.numColors();
unsigned int *data = img.depth() > 8 ? (unsigned int *)img.bits() :
(unsigned int *)img.colorTable();
int val, i;
for(i=0; i < pixels; ++i){
val = qGray(data[i]);
data[i] = qRgba(val, val, val, qAlpha(data[i]));
}
}
return img;
}
// CT 29Jan2000 - desaturation algorithms
QImage& KImageEffect::desaturate(QImage &image, float desat)
{
if (image.width() == 0 || image.height() == 0)
return image;
if (desat < 0) desat = 0.;
if (desat > 1) desat = 1.;
int pixels = image.depth() > 8 ? image.width()*image.height() : image.numColors();
unsigned int *data = image.depth() > 8 ? (unsigned int *)image.bits() : (unsigned int *)image.colorTable();
int h, s, v, i;
uint col;
QColor clr; // keep constructor out of loop (mosfet)
for (i = 0; i < pixels; ++i)
{
col = data[i];
INVERT(col);
clr.setRgb(col);
clr.hsv(&h, &s, &v);
clr.setHsv(h, (int)(s * (1. - desat)), v);
data[i] = clr.rgb();
INVERT(data[i]);
}
return image;
}
#if 0
// Contrast stuff (mosfet)
QImage& KImageEffect::contrast(QImage &img, int c)
{
if (img.width() == 0 || img.height() == 0)
return img;
if(c > 255)
c = 255;
if(c < -255)
c = -255;
int pixels = img.depth() > 8 ? img.width()*img.height() :
img.numColors();
unsigned int *data = img.depth() > 8 ? (unsigned int *)img.bits() :
(unsigned int *)img.colorTable();
int i, r, g, b;
for(i=0; i < pixels; ++i){
r = qRed(data[i]);
g = qGreen(data[i]);
b = qBlue(data[i]);
if(qGray(data[i]) <= 127){
if(r - c <= 255)
r -= c;
if(g - c <= 255)
g -= c;
if(b - c <= 255)
b -= c;
}
else{
if(r + c <= 255)
r += c;
if(g + c <= 255)
g += c;
if(b + c <= 255)
b += c;
}
data[i] = qRgba(r, g, b, qAlpha(data[i]));
}
return(img);
}
#endif
#if 0
//======================================================================
//
// Dithering effects
//
//======================================================================
// adapted from kFSDither (C) 1997 Martin Jones (mjones@kde.org)
//
// Floyd-Steinberg dithering
// Ref: Bitmapped Graphics Programming in C++
// Marv Luse, Addison-Wesley Publishing, 1993.
QImage& KImageEffect::dither(QImage &img, const QColor *palette, int size)
{
if (img.width() == 0 || img.height() == 0 ||
palette == 0 || img.depth() <= 8)
return img;
QImage dImage( img.width(), img.height(), 8, size );
int i;
dImage.setNumColors( size );
for ( i = 0; i < size; i++ )
dImage.setColor( i, palette[ i ].rgb() );
int *rerr1 = new int [ img.width() * 2 ];
int *gerr1 = new int [ img.width() * 2 ];
int *berr1 = new int [ img.width() * 2 ];
memset( rerr1, 0, sizeof( int ) * img.width() * 2 );
memset( gerr1, 0, sizeof( int ) * img.width() * 2 );
memset( berr1, 0, sizeof( int ) * img.width() * 2 );
int *rerr2 = rerr1 + img.width();
int *gerr2 = gerr1 + img.width();
int *berr2 = berr1 + img.width();
for ( int j = 0; j < img.height(); j++ )
{
uint *ip = (uint * )img.scanLine( j );
uchar *dp = dImage.scanLine( j );
for ( i = 0; i < img.width(); i++ )
{
rerr1[i] = rerr2[i] + qRed( *ip );
rerr2[i] = 0;
gerr1[i] = gerr2[i] + qGreen( *ip );
gerr2[i] = 0;
berr1[i] = berr2[i] + qBlue( *ip );
berr2[i] = 0;
ip++;
}
*dp++ = nearestColor( rerr1[0], gerr1[0], berr1[0], palette, size );
for ( i = 1; i < img.width()-1; i++ )
{
int indx = nearestColor( rerr1[i], gerr1[i], berr1[i], palette, size );
*dp = indx;
int rerr = rerr1[i];
rerr -= palette[indx].red();
int gerr = gerr1[i];
gerr -= palette[indx].green();
int berr = berr1[i];
berr -= palette[indx].blue();
// diffuse red error
rerr1[ i+1 ] += ( rerr * 7 ) >> 4;
rerr2[ i-1 ] += ( rerr * 3 ) >> 4;
rerr2[ i ] += ( rerr * 5 ) >> 4;
rerr2[ i+1 ] += ( rerr ) >> 4;
// diffuse green error
gerr1[ i+1 ] += ( gerr * 7 ) >> 4;
gerr2[ i-1 ] += ( gerr * 3 ) >> 4;
gerr2[ i ] += ( gerr * 5 ) >> 4;
gerr2[ i+1 ] += ( gerr ) >> 4;
// diffuse red error
berr1[ i+1 ] += ( berr * 7 ) >> 4;
berr2[ i-1 ] += ( berr * 3 ) >> 4;
berr2[ i ] += ( berr * 5 ) >> 4;
berr2[ i+1 ] += ( berr ) >> 4;
dp++;
}
*dp = nearestColor( rerr1[i], gerr1[i], berr1[i], palette, size );
}
delete [] rerr1;
delete [] gerr1;
delete [] berr1;
img = dImage;
return img;
}
int KImageEffect::nearestColor( int r, int g, int b, const QColor *palette, int size )
{
if (palette == 0)
return 0;
int dr = palette[0].red() - r;
int dg = palette[0].green() - g;
int db = palette[0].blue() - b;
int minDist = dr*dr + dg*dg + db*db;
int nearest = 0;
for (int i = 1; i < size; i++ )
{
dr = palette[i].red() - r;
dg = palette[i].green() - g;
db = palette[i].blue() - b;
int dist = dr*dr + dg*dg + db*db;
if ( dist < minDist )
{
minDist = dist;
nearest = i;
}
}
return nearest;
}
bool KImageEffect::blend(
const QImage & upper,
const QImage & lower,
QImage & output
)
{
if (
upper.width() > lower.width() ||
upper.height() > lower.height() ||
upper.depth() != 32 ||
lower.depth() != 32
)
{
#ifndef NDEBUG
std::cerr << "KImageEffect::blend : Sizes not correct\n" ;
#endif
return false;
}
output = lower.copy();
register uchar *i, *o;
register int a;
register int col;
register int w = upper.width();
int row(upper.height() - 1);
do {
i = upper.scanLine(row);
o = output.scanLine(row);
col = w << 2;
--col;
do {
while (!(a = i[col]) && (col != 3)) {
--col; --col; --col; --col;
}
--col;
o[col] += ((i[col] - o[col]) * a) >> 8;
--col;
o[col] += ((i[col] - o[col]) * a) >> 8;
--col;
o[col] += ((i[col] - o[col]) * a) >> 8;
} while (col--);
} while (row--);
return true;
}
#if 0
// Not yet...
bool KImageEffect::blend(
const QImage & upper,
const QImage & lower,
QImage & output,
const QRect & destRect
)
{
output = lower.copy();
return output;
}
#endif
bool KImageEffect::blend(
int &x, int &y,
const QImage & upper,
const QImage & lower,
QImage & output
)
{
int cx=0, cy=0, cw=upper.width(), ch=upper.height();
if ( upper.width() + x > lower.width() ||
upper.height() + y > lower.height() ||
x < 0 || y < 0 ||
upper.depth() != 32 || lower.depth() != 32 )
{
if ( x > lower.width() || y > lower.height() ) return false;
if ( upper.width()<=0 || upper.height() <= 0 ) return false;
if ( lower.width()<=0 || lower.height() <= 0 ) return false;
if (x<0) {cx=-x; cw+=x; x=0; };
if (cw + x > lower.width()) { cw=lower.width()-x; };
if (y<0) {cy=-y; ch+=y; y=0; };
if (ch + y > lower.height()) { ch=lower.height()-y; };
if ( cx >= upper.width() || cy >= upper.height() ) return true;
if ( cw <= 0 || ch <= 0 ) return true;
}
output.create(cw,ch,32);
// output.setAlphaBuffer(true); // I should do some benchmarks to see if
// this is worth the effort
register QRgb *i, *o, *b;
register int a;
register int j,k;
for (j=0; j<ch; j++)
{
b=reinterpret_cast<QRgb *>(&lower.scanLine(y+j) [ (x+cw) << 2 ]);
i=reinterpret_cast<QRgb *>(&upper.scanLine(cy+j)[ (cx+cw) << 2 ]);
o=reinterpret_cast<QRgb *>(&output.scanLine(j) [ cw << 2 ]);
k=cw-1;
--b; --i; --o;
do
{
while ( !(a=qAlpha(*i)) && k>0 )
{
i--;
// *o=0;
*o=*b;
--o; --b;
k--;
};
// *o=0xFF;
*o = qRgb(qRed(*b) + (((qRed(*i) - qRed(*b)) * a) >> 8),
qGreen(*b) + (((qGreen(*i) - qGreen(*b)) * a) >> 8),
qBlue(*b) + (((qBlue(*i) - qBlue(*b)) * a) >> 8));
--i; --o; --b;
} while (k--);
}
return true;
}
bool KImageEffect::blendOnLower(
int x, int y,
const QImage & upper,
const QImage & lower
)
{
int cx=0, cy=0, cw=upper.width(), ch=upper.height();
if ( upper.depth() != 32 || lower.depth() != 32 ) return false;
if ( x + cw > lower.width() ||
y + ch > lower.height() ||
x < 0 || y < 0 )
{
if ( x > lower.width() || y > lower.height() ) return true;
if ( upper.width()<=0 || upper.height() <= 0 ) return true;
if ( lower.width()<=0 || lower.height() <= 0 ) return true;
if (x<0) {cx=-x; cw+=x; x=0; };
if (cw + x > lower.width()) { cw=lower.width()-x; };
if (y<0) {cy=-y; ch+=y; y=0; };
if (ch + y > lower.height()) { ch=lower.height()-y; };
if ( cx >= upper.width() || cy >= upper.height() ) return true;
if ( cw <= 0 || ch <= 0 ) return true;
}
register uchar *i, *b;
register int a;
register int k;
for (int j=0; j<ch; j++)
{
b=&lower.scanLine(y+j) [ (x+cw) << 2 ];
i=&upper.scanLine(cy+j)[ (cx+cw) << 2 ];
k=cw-1;
--b; --i;
do
{
#ifndef WORDS_BIGENDIAN
while ( !(a=*i) && k>0 )
#else
while ( !(a=*(i-3)) && k>0 )
#endif
{
i-=4; b-=4; k--;
};
#ifndef WORDS_BIGENDIAN
--i; --b;
*b += ( ((*i - *b) * a) >> 8 );
--i; --b;
*b += ( ((*i - *b) * a) >> 8 );
--i; --b;
*b += ( ((*i - *b) * a) >> 8 );
--i; --b;
#else
*b += ( ((*i - *b) * a) >> 8 );
--i; --b;
*b += ( ((*i - *b) * a) >> 8 );
--i; --b;
*b += ( ((*i - *b) * a) >> 8 );
i -= 2; b -= 2;
#endif
} while (k--);
}
return true;
}
void KImageEffect::blendOnLower(const QImage &upper, const QPoint &upperOffset,
QImage &lower, const QRect &lowerRect)
{
// clip rect
QRect lr = lowerRect & lower.rect();
lr.setWidth( QMIN(lr.width(), upper.width()-upperOffset.x()) );
lr.setHeight( QMIN(lr.height(), upper.height()-upperOffset.y()) );
if ( !lr.isValid() ) return;
// blend
for (int y = 0; y < lr.height(); y++) {
for (int x = 0; x < lr.width(); x++) {
QRgb *b = reinterpret_cast<QRgb*>(lower.scanLine(lr.y() + y)+ (lr.x() + x) * sizeof(QRgb));
QRgb *d = reinterpret_cast<QRgb*>(upper.scanLine(upperOffset.y() + y) + (upperOffset.x() + x) * sizeof(QRgb));
int a = qAlpha(*d);
*b = qRgb(qRed(*b) - (((qRed(*b) - qRed(*d)) * a) >> 8),
qGreen(*b) - (((qGreen(*b) - qGreen(*d)) * a) >> 8),
qBlue(*b) - (((qBlue(*b) - qBlue(*d)) * a) >> 8));
}
}
}
void KImageEffect::blendOnLower(const QImage &upper, const QPoint &upperOffset,
QImage &lower, const QRect &lowerRect, float opacity)
{
// clip rect
QRect lr = lowerRect & lower.rect();
lr.setWidth( QMIN(lr.width(), upper.width()-upperOffset.x()) );
lr.setHeight( QMIN(lr.height(), upper.height()-upperOffset.y()) );
if ( !lr.isValid() ) return;
// blend
for (int y = 0; y < lr.height(); y++) {
for (int x = 0; x < lr.width(); x++) {
QRgb *b = reinterpret_cast<QRgb*>(lower.scanLine(lr.y() + y)+ (lr.x() + x) * sizeof(QRgb));
QRgb *d = reinterpret_cast<QRgb*>(upper.scanLine(upperOffset.y() + y) + (upperOffset.x() + x) * sizeof(QRgb));
int a = qRound(opacity * qAlpha(*d));
*b = qRgb(qRed(*b) - (((qRed(*b) - qRed(*d)) * a) >> 8),
qGreen(*b) - (((qGreen(*b) - qGreen(*d)) * a) >> 8),
qBlue(*b) - (((qBlue(*b) - qBlue(*d)) * a) >> 8));
}
}
}
QRect KImageEffect::computeDestinationRect(const QSize &lowerSize,
Disposition disposition, QImage &upper)
{
int w = lowerSize.width();
int h = lowerSize.height();
int ww = upper.width();
int wh = upper.height();
QRect d;
switch (disposition) {
case NoImage:
break;
case Centered:
d.setRect((w - ww) / 2, (h - wh) / 2, ww, wh);
break;
case Tiled:
d.setRect(0, 0, w, h);
break;
case CenterTiled:
d.setCoords(-ww + ((w - ww) / 2) % ww, -wh + ((h - wh) / 2) % wh,
w-1, h-1);
break;
case Scaled:
upper = upper.smoothScale(w, h);
d.setRect(0, 0, w, h);
break;
case CenteredAutoFit:
if( ww <= w && wh <= h ) {
d.setRect((w - ww) / 2, (h - wh) / 2, ww, wh); // like Centered
break;
}
// fall through
case CenteredMaxpect: {
double sx = (double) w / ww;
double sy = (double) h / wh;
if (sx > sy) {
ww = (int)(sy * ww);
wh = h;
} else {
wh = (int)(sx * wh);
ww = w;
}
upper = upper.smoothScale(ww, wh);
d.setRect((w - ww) / 2, (h - wh) / 2, ww, wh);
break;
}
case TiledMaxpect: {
double sx = (double) w / ww;
double sy = (double) h / wh;
if (sx > sy) {
ww = (int)(sy * ww);
wh = h;
} else {
wh = (int)(sx * wh);
ww = w;
}
upper = upper.smoothScale(ww, wh);
d.setRect(0, 0, w, h);
break;
}
}
return d;
}
void KImageEffect::blendOnLower(QImage &upper, QImage &lower,
Disposition disposition, float opacity)
{
QRect r = computeDestinationRect(lower.size(), disposition, upper);
for (int y = r.top(); y<r.bottom(); y += upper.height())
for (int x = r.left(); x<r.right(); x += upper.width())
blendOnLower(upper, QPoint(-QMIN(x, 0), -QMIN(y, 0)),
lower, QRect(x, y, upper.width(), upper.height()), opacity);
}
// For selected icons
QImage& KImageEffect::selectedImage( QImage &img, const QColor &col )
{
return blend( col, img, 0.5);
}
#endif
//
// ===================================================================
// Effects originally ported from ImageMagick for PixiePlus, plus a few
// new ones. (mosfet 05/26/2003)
// ===================================================================
//
/*
Portions of this software are based on ImageMagick. Such portions are clearly
marked as being ported from ImageMagick. ImageMagick is copyrighted under the
following conditions:
Copyright (C) 2003 ImageMagick Studio, a non-profit organization dedicated to
making software imaging solutions freely available.
Permission is hereby granted, free of charge, to any person obtaining a copy
of this software and associated documentation files ("ImageMagick"), to deal
in ImageMagick without restriction, including without limitation the rights
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
copies of ImageMagick, and to permit persons to whom the ImageMagick is
furnished to do so, subject to the following conditions:
The above copyright notice and this permission notice shall be included in all
copies or substantial portions of ImageMagick.
The software is provided "as is", without warranty of any kind, express or
implied, including but not limited to the warranties of merchantability,
fitness for a particular purpose and noninfringement. In no event shall
ImageMagick Studio be liable for any claim, damages or other liability,
whether in an action of contract, tort or otherwise, arising from, out of or
in connection with ImageMagick or the use or other dealings in ImageMagick.
Except as contained in this notice, the name of the ImageMagick Studio shall
not be used in advertising or otherwise to promote the sale, use or other
dealings in ImageMagick without prior written authorization from the
ImageMagick Studio.
*/
#if 0
QImage KImageEffect::sample(QImage &src, int w, int h)
{
if(w == src.width() && h == src.height())
return(src);
double *x_offset, *y_offset;
int j, k, y;
register int x;
QImage dest(w, h, src.depth());
x_offset = (double *)malloc(w*sizeof(double));
y_offset = (double *)malloc(h*sizeof(double));
if(!x_offset || !y_offset){
//qWarning("KImageEffect::sample(): Unable to allocate pixels buffer");
free(x_offset);
free(y_offset);
return(src);
}
// init pixel offsets
for(x=0; x < w; ++x)
x_offset[x] = x*src.width()/((double)w);
for(y=0; y < h; ++y)
y_offset[y] = y*src.height()/((double)h);
// sample each row
if(src.depth() > 8){ // DirectClass source image
unsigned int *srcData, *destData;
unsigned int *pixels;
pixels = (unsigned int *)malloc(src.width()*sizeof(unsigned int));
if(!pixels){
//qWarning("KImageEffect::sample(): Unable to allocate pixels buffer");
free(pixels);
free(x_offset);
free(y_offset);
return(src);
}
j = (-1);
for(y=0; y < h; ++y){
destData = (unsigned int *)dest.scanLine(y);
if(j != y_offset[y]){
// read a scan line
j = (int)(y_offset[y]);
srcData = (unsigned int *)src.scanLine(j);
(void)memcpy(pixels, srcData, src.width()*sizeof(unsigned int));
}
// sample each column
for(x=0; x < w; ++x){
k = (int)(x_offset[x]);
destData[x] = pixels[k];
}
}
free(pixels);
}
/*
else{ // PsudeoClass source image
unsigned char *srcData, *destData;
unsigned char *pixels;
pixels = (unsigned char *)malloc(src.width()*sizeof(unsigned char));
if(!pixels){
qWarning("KImageEffect::sample(): Unable to allocate pixels buffer");
free(pixels);
free(x_offset);
free(y_offset);
return(src);
}
// copy colortable
dest.setNumColors(src.numColors());
(void)memcpy(dest.colorTable(), src.colorTable(),
src.numColors()*sizeof(unsigned int));
// sample image
j = (-1);
for(y=0; y < h; ++y){
destData = (unsigned char *)dest.scanLine(y);
if(j != y_offset[y]){
// read a scan line
j = (int)(y_offset[y]);
srcData = (unsigned char *)src.scanLine(j);
(void)memcpy(pixels, srcData, src.width()*sizeof(unsigned char));
}
// sample each column
for(x=0; x < w; ++x){
k = (int)(x_offset[x]);
destData[x] = pixels[k];
}
}
free(pixels);
}*/
free(x_offset);
free(y_offset);
return(dest);
}
#endif
void KImageEffect::threshold(QImage &img, unsigned int threshold)
{
int i, count;
unsigned int *data;
if(img.depth() > 8){ // DirectClass
count = img.width()*img.height();
data = (unsigned int *)img.bits();
}
/*else{ // PsudeoClass
count = img.numColors();
data = (unsigned int *)img.colorTable();
}*/
if (img.inverted())
{
for(i=0; i < count; ++i)
data[i] = intensityValue(invert(data[i])) < threshold ? 0xFF000000 : 0xFFFFFFFF;
}
else
{
for(i=0; i < count; ++i)
data[i] = intensityValue(data[i]) < threshold ? 0xFF000000 : 0xFFFFFFFF;
}
}
void KImageEffect::hull(const int x_offset, const int y_offset,
const int polarity, const int columns,
const int rows,
unsigned int *f, unsigned int *g)
{
int x, y;
unsigned int *p, *q, *r, *s;
unsigned int v;
if(f == NULL || g == NULL)
return;
p=f+(columns+2);
q=g+(columns+2);
r=p+(y_offset*(columns+2)+x_offset);
for (y=0; y < rows; y++){
p++;
q++;
r++;
if(polarity > 0)
for (x=0; x < columns; x++){
v=(*p);
if (*r > v)
v++;
*q=v;
p++;
q++;
r++;
}
else
for(x=0; x < columns; x++){
v=(*p);
if (v > (unsigned int) (*r+1))
v--;
*q=v;
p++;
q++;
r++;
}
p++;
q++;
r++;
}
p=f+(columns+2);
q=g+(columns+2);
r=q+(y_offset*(columns+2)+x_offset);
s=q-(y_offset*(columns+2)+x_offset);
for(y=0; y < rows; y++){
p++;
q++;
r++;
s++;
if(polarity > 0)
for(x=0; x < (int) columns; x++){
v=(*q);
if (((unsigned int) (*s+1) > v) && (*r > v))
v++;
*p=v;
p++;
q++;
r++;
s++;
}
else
for (x=0; x < columns; x++){
v=(*q);
if (((unsigned int) (*s+1) < v) && (*r < v))
v--;
*p=v;
p++;
q++;
r++;
s++;
}
p++;
q++;
r++;
s++;
}
}
QImage KImageEffect::despeckle(QImage &src)
{
int i, j, x, y;
unsigned int *blue_channel, *red_channel, *green_channel, *buffer,
*alpha_channel;
int packets;
static const int
X[4]= {0, 1, 1,-1},
Y[4]= {1, 0, 1, 1};
unsigned int *destData;
QImage dest(src.width(), src.height(), src.transparent());
packets = (src.width()+2)*(src.height()+2);
red_channel = (unsigned int *)calloc(packets, sizeof(unsigned int));
green_channel = (unsigned int *)calloc(packets, sizeof(unsigned int));
blue_channel = (unsigned int *)calloc(packets, sizeof(unsigned int));
alpha_channel = (unsigned int *)calloc(packets, sizeof(unsigned int));
buffer = (unsigned int *)calloc(packets, sizeof(unsigned int));
if(!red_channel || ! green_channel || ! blue_channel || ! alpha_channel ||
!buffer){
free(red_channel);
free(green_channel);
free(blue_channel);
free(alpha_channel);
free(buffer);
return(src);
}
// copy image pixels to color component buffers
j = src.width()+2;
if(src.depth() > 8){ // DirectClass source image
unsigned int *srcData;
for(y=0; y < src.height(); ++y){
srcData = (unsigned int *)src.scanLine(y);
++j;
for(x=0; x < src.width(); ++x){
red_channel[j] = qRed(srcData[x]);
green_channel[j] = qGreen(srcData[x]);
blue_channel[j] = qBlue(srcData[x]);
alpha_channel[j] = qAlpha(srcData[x]);
++j;
}
++j;
}
}
/*
else { // PsudeoClass source image
unsigned char *srcData;
unsigned int *cTable = src.colorTable();
unsigned int pixel;
for(y=0; y < src.height(); ++y){
srcData = (unsigned char *)src.scanLine(y);
++j;
for(x=0; x < src.width(); ++x){
pixel = *(cTable+srcData[x]);
red_channel[j] = qRed(pixel);
green_channel[j] = qGreen(pixel);
blue_channel[j] = qBlue(pixel);
alpha_channel[j] = qAlpha(pixel);
++j;
}
++j;
}
}*/
// reduce speckle in red channel
for(i=0; i < 4; i++){
hull(X[i],Y[i],1,src.width(),src.height(),red_channel,buffer);
hull(-X[i],-Y[i],1,src.width(),src.height(),red_channel,buffer);
hull(-X[i],-Y[i],-1,src.width(),src.height(),red_channel,buffer);
hull(X[i],Y[i],-1,src.width(),src.height(),red_channel,buffer);
}
// reduce speckle in green channel
for (i=0; i < packets; i++)
buffer[i]=0;
for (i=0; i < 4; i++){
hull(X[i],Y[i],1,src.width(),src.height(),green_channel,buffer);
hull(-X[i],-Y[i],1,src.width(),src.height(),green_channel,buffer);
hull(-X[i],-Y[i],-1,src.width(),src.height(),green_channel,buffer);
hull(X[i],Y[i],-1,src.width(),src.height(),green_channel,buffer);
}
// reduce speckle in blue channel
for (i=0; i < packets; i++)
buffer[i]=0;
for (i=0; i < 4; i++){
hull(X[i],Y[i],1,src.width(),src.height(),blue_channel,buffer);
hull(-X[i],-Y[i],1,src.width(),src.height(),blue_channel,buffer);
hull(-X[i],-Y[i],-1,src.width(),src.height(),blue_channel,buffer);
hull(X[i],Y[i],-1,src.width(),src.height(),blue_channel,buffer);
}
// copy color component buffers to despeckled image
j = dest.width()+2;
for(y=0; y < dest.height(); ++y)
{
destData = (unsigned int *)dest.scanLine(y);
++j;
for (x=0; x < dest.width(); ++x)
{
destData[x] = qRgba(red_channel[j], green_channel[j],
blue_channel[j], alpha_channel[j]);
++j;
}
++j;
}
free(buffer);
free(red_channel);
free(green_channel);
free(blue_channel);
free(alpha_channel);
return(dest);
}
unsigned int KImageEffect::generateNoise(unsigned int pixel,
NoiseType noise_type)
{
#define NoiseEpsilon 1.0e-5
#define NoiseMask 0x7fff
#define SigmaUniform 4.0
#define SigmaGaussian 4.0
#define SigmaImpulse 0.10
#define SigmaLaplacian 10.0
#define SigmaMultiplicativeGaussian 0.5
#define SigmaPoisson 0.05
#define TauGaussian 20.0
double alpha, beta, sigma, value;
alpha=(double) (rand() & NoiseMask)/NoiseMask;
if (alpha == 0.0)
alpha=1.0;
switch(noise_type){
case UniformNoise:
default:
{
value=(double) pixel+SigmaUniform*(alpha-0.5);
break;
}
case GaussianNoise:
{
double tau;
beta=(double) (rand() & NoiseMask)/NoiseMask;
sigma=sqrt(-2.0*log(alpha))*cos(2.0*M_PI*beta);
tau=sqrt(-2.0*log(alpha))*sin(2.0*M_PI*beta);
value=(double) pixel+
(sqrt((double) pixel)*SigmaGaussian*sigma)+(TauGaussian*tau);
break;
}
case MultiplicativeGaussianNoise:
{
if (alpha <= NoiseEpsilon)
sigma=MaxRGB;
else
sigma=sqrt(-2.0*log(alpha));
beta=(rand() & NoiseMask)/NoiseMask;
value=(double) pixel+
pixel*SigmaMultiplicativeGaussian*sigma*cos(2.0*M_PI*beta);
break;
}
case ImpulseNoise:
{
if (alpha < (SigmaImpulse/2.0))
value=0;
else
if (alpha >= (1.0-(SigmaImpulse/2.0)))
value=MaxRGB;
else
value=pixel;
break;
}
case LaplacianNoise:
{
if (alpha <= 0.5)
{
if (alpha <= NoiseEpsilon)
value=(double) pixel-MaxRGB;
else
value=(double) pixel+SigmaLaplacian*log(2.0*alpha);
break;
}
beta=1.0-alpha;
if (beta <= (0.5*NoiseEpsilon))
value=(double) pixel+MaxRGB;
else
value=(double) pixel-SigmaLaplacian*log(2.0*beta);
break;
}
case PoissonNoise:
{
register int
i;
for (i=0; alpha > exp(-SigmaPoisson*pixel); i++)
{
beta=(double) (rand() & NoiseMask)/NoiseMask;
alpha=alpha*beta;
}
value=i/SigmaPoisson;
break;
}
}
if(value < 0.0)
return(0);
if(value > MaxRGB)
return(MaxRGB);
return((unsigned int) (value+0.5));
}
QImage KImageEffect::addNoise(QImage &src, NoiseType noise_type)
{
int x, y;
QImage dest(src.width(), src.height(), 32);
unsigned int *destData;
if(src.depth() > 8){ // DirectClass source image
unsigned int *srcData;
for(y=0; y < src.height(); ++y){
srcData = (unsigned int *)src.scanLine(y);
destData = (unsigned int *)dest.scanLine(y);
for(x=0; x < src.width(); ++x){
destData[x] = qRgba(generateNoise(qRed(srcData[x]), noise_type),
generateNoise(qGreen(srcData[x]), noise_type),
generateNoise(qBlue(srcData[x]), noise_type),
qAlpha(srcData[x]));
}
}
}
/*else{ // PsudeoClass source image
unsigned char *srcData;
unsigned int *cTable = src.colorTable();
unsigned int pixel;
for(y=0; y < src.height(); ++y){
srcData = (unsigned char *)src.scanLine(y);
destData = (unsigned int *)dest.scanLine(y);
for(x=0; x < src.width(); ++x){
pixel = *(cTable+srcData[x]);
destData[x] = qRgba(generateNoise(qRed(pixel), noise_type),
generateNoise(qGreen(pixel), noise_type),
generateNoise(qBlue(pixel), noise_type),
qAlpha(pixel));
}
}
}*/
return(dest);
}
unsigned int KImageEffect::interpolateColor(QImage *image, double x_offset,
double y_offset,
unsigned int background)
{
double alpha, beta;
unsigned int p, q, r, s;
int x, y;
x = (int)x_offset;
y = (int)y_offset;
if((x < -1) || (x >= image->width()) || (y < -1) || (y >= image->height()))
return(background);
if(image->depth() > 8){
if((x >= 0) && (y >= 0) && (x < (image->width()-1)) && (y < (image->height()-1))) {
unsigned int *t = (unsigned int *)image->scanLine(y);
p = t[x];
q = t[x+1];
r = t[x+image->width()];
s = t[x+image->width()+1];
}
else{
unsigned int *t = (unsigned int *)image->scanLine(y);
p = background;
if((x >= 0) && (y >= 0)){
p = t[x];
}
q = background;
if(((x+1) < image->width()) && (y >= 0)){
q = t[x+1];
}
r = background;
if((x >= 0) && ((y+1) < image->height())){
t = (unsigned int *)image->scanLine(y+1);
r = t[x+image->width()];
}
s = background;
if(((x+1) < image->width()) && ((y+1) < image->height())){
t = (unsigned int *)image->scanLine(y+1);
s = t[x+image->width()+1];
}
}
}
/*else{
unsigned int *colorTable = (unsigned int *)image->colorTable();
if((x >= 0) && (y >= 0) && (x < (image->width()-1)) && (y < (image->height()-1))) {
unsigned char *t;
t = (unsigned char *)image->scanLine(y);
p = *(colorTable+t[x]);
q = *(colorTable+t[x+1]);
t = (unsigned char *)image->scanLine(y+1);
r = *(colorTable+t[x]);
s = *(colorTable+t[x+1]);
}
else{
unsigned char *t;
p = background;
if((x >= 0) && (y >= 0)){
t = (unsigned char *)image->scanLine(y);
p = *(colorTable+t[x]);
}
q = background;
if(((x+1) < image->width()) && (y >= 0)){
t = (unsigned char *)image->scanLine(y);
q = *(colorTable+t[x+1]);
}
r = background;
if((x >= 0) && ((y+1) < image->height())){
t = (unsigned char *)image->scanLine(y+1);
r = *(colorTable+t[x]);
}
s = background;
if(((x+1) < image->width()) && ((y+1) < image->height())){
t = (unsigned char *)image->scanLine(y+1);
s = *(colorTable+t[x+1]);
}
}
}*/
x_offset -= floor(x_offset);
y_offset -= floor(y_offset);
alpha = 1.0-x_offset;
beta = 1.0-y_offset;
return(qRgba((unsigned char)(beta*(alpha*qRed(p)+x_offset*qRed(q))+y_offset*(alpha*qRed(r)+x_offset*qRed(s))),
(unsigned char)(beta*(alpha*qGreen(p)+x_offset*qGreen(q))+y_offset*(alpha*qGreen(r)+x_offset*qGreen(s))),
(unsigned char)(beta*(alpha*qBlue(p)+x_offset*qBlue(q))+y_offset*(alpha*qBlue(r)+x_offset*qBlue(s))),
(unsigned char)(beta*(alpha*qAlpha(p)+x_offset*qAlpha(q))+y_offset*(alpha*qAlpha(r)+x_offset*qAlpha(s)))));
}
QImage KImageEffect::implode(QImage &src, double factor,
unsigned int background)
{
double amount, distance, radius;
double x_center, x_distance, x_scale;
double y_center, y_distance, y_scale;
unsigned int *destData;
int x, y;
QImage dest(src.width(), src.height(), src.transparent());
// compute scaling factor
x_scale = 1.0;
y_scale = 1.0;
x_center = (double)0.5*src.width();
y_center = (double)0.5*src.height();
radius=x_center;
if(src.width() > src.height())
y_scale = (double)src.width()/src.height();
else if(src.width() < src.height()){
x_scale = (double) src.height()/src.width();
radius = y_center;
}
amount=factor/10.0;
if(amount >= 0)
amount/=10.0;
if(src.depth() > 8){ // DirectClass source image
unsigned int *srcData;
for(y=0; y < src.height(); ++y){
srcData = (unsigned int *)src.scanLine(y);
destData = (unsigned int *)dest.scanLine(y);
y_distance=y_scale*(y-y_center);
for(x=0; x < src.width(); ++x){
destData[x] = srcData[x];
x_distance = x_scale*(x-x_center);
distance= x_distance*x_distance+y_distance*y_distance;
if(distance < (radius*radius)){
double factor;
// Implode the pixel.
factor=1.0;
if(distance > 0.0)
factor=
pow(sin(0.5000000000000001*M_PI*sqrt(distance)/radius),-amount);
destData[x] = interpolateColor(&src, factor*x_distance/x_scale+x_center,
factor*y_distance/y_scale+y_center,
background);
}
}
}
}
/*else{ // PsudeoClass source image
unsigned char *srcData;
unsigned char idx;
unsigned int *cTable = src.colorTable();
for(y=0; y < src.height(); ++y){
srcData = (unsigned char *)src.scanLine(y);
destData = (unsigned int *)dest.scanLine(y);
y_distance=y_scale*(y-y_center);
for(x=0; x < src.width(); ++x){
idx = srcData[x];
destData[x] = cTable[idx];
x_distance = x_scale*(x-x_center);
distance= x_distance*x_distance+y_distance*y_distance;
if(distance < (radius*radius)){
double factor;
// Implode the pixel.
factor=1.0;
if(distance > 0.0)
factor=
pow(sin(0.5000000000000001*M_PI*sqrt(distance)/radius),-amount);
destData[x] = interpolateColor(&src, factor*x_distance/x_scale+x_center,
factor*y_distance/y_scale+y_center,
background);
}
}
}
}*/
return(dest);
}
#if 0
QImage KImageEffect::rotate(QImage &img, RotateDirection r)
{
QImage dest;
int x, y;
if(img.depth() > 8){
unsigned int *srcData, *destData;
switch(r){
case Rotate90:
dest.create(img.height(), img.width(), img.depth());
for(y=0; y < img.height(); ++y){
srcData = (unsigned int *)img.scanLine(y);
for(x=0; x < img.width(); ++x){
destData = (unsigned int *)dest.scanLine(x);
destData[img.height()-y-1] = srcData[x];
}
}
break;
case Rotate180:
dest.create(img.width(), img.height(), img.depth());
for(y=0; y < img.height(); ++y){
srcData = (unsigned int *)img.scanLine(y);
destData = (unsigned int *)dest.scanLine(img.height()-y-1);
for(x=0; x < img.width(); ++x)
destData[img.width()-x-1] = srcData[x];
}
break;
case Rotate270:
dest.create(img.height(), img.width(), img.depth());
for(y=0; y < img.height(); ++y){
srcData = (unsigned int *)img.scanLine(y);
for(x=0; x < img.width(); ++x){
destData = (unsigned int *)dest.scanLine(img.width()-x-1);
destData[y] = srcData[x];
}
}
break;
default:
dest = img;
break;
}
}
else{
unsigned char *srcData, *destData;
unsigned int *srcTable, *destTable;
switch(r){
case Rotate90:
dest.create(img.height(), img.width(), img.depth());
dest.setNumColors(img.numColors());
srcTable = (unsigned int *)img.colorTable();
destTable = (unsigned int *)dest.colorTable();
for(x=0; x < img.numColors(); ++x)
destTable[x] = srcTable[x];
for(y=0; y < img.height(); ++y){
srcData = (unsigned char *)img.scanLine(y);
for(x=0; x < img.width(); ++x){
destData = (unsigned char *)dest.scanLine(x);
destData[img.height()-y-1] = srcData[x];
}
}
break;
case Rotate180:
dest.create(img.width(), img.height(), img.depth());
dest.setNumColors(img.numColors());
srcTable = (unsigned int *)img.colorTable();
destTable = (unsigned int *)dest.colorTable();
for(x=0; x < img.numColors(); ++x)
destTable[x] = srcTable[x];
for(y=0; y < img.height(); ++y){
srcData = (unsigned char *)img.scanLine(y);
destData = (unsigned char *)dest.scanLine(img.height()-y-1);
for(x=0; x < img.width(); ++x)
destData[img.width()-x-1] = srcData[x];
}
break;
case Rotate270:
dest.create(img.height(), img.width(), img.depth());
dest.setNumColors(img.numColors());
srcTable = (unsigned int *)img.colorTable();
destTable = (unsigned int *)dest.colorTable();
for(x=0; x < img.numColors(); ++x)
destTable[x] = srcTable[x];
for(y=0; y < img.height(); ++y){
srcData = (unsigned char *)img.scanLine(y);
for(x=0; x < img.width(); ++x){
destData = (unsigned char *)dest.scanLine(img.width()-x-1);
destData[y] = srcData[x];
}
}
break;
default:
dest = img;
break;
}
}
return(dest);
}
#endif
void KImageEffect::solarize(QImage &img, double factor)
{
int i, count;
int threshold;
unsigned int *data;
threshold = (int)(factor*(MaxRGB+1)/100.0);
/*if(img.depth() < 32){
data = (unsigned int *)img.colorTable();
count = img.numColors();
}
else*/{
data = (unsigned int *)img.bits();
count = img.width()*img.height();
}
for(i=0; i < count; ++i){
data[i] = qRgba(qRed(data[i]) > threshold ? MaxRGB-qRed(data[i]) : qRed(data[i]),
qGreen(data[i]) > threshold ? MaxRGB-qGreen(data[i]) : qGreen(data[i]),
qBlue(data[i]) > threshold ? MaxRGB-qBlue(data[i]) : qBlue(data[i]),
qAlpha(data[i]));
}
}
QImage KImageEffect::spread(QImage &src, unsigned int amount)
{
int quantum, x, y;
int x_distance, y_distance;
if(src.width() < 3 || src.height() < 3)
return(src);
QImage dest(src.width(), src.height(), src.transparent());
quantum=(amount+1) >> 1;
if(src.depth() > 8){ // DirectClass source image
unsigned int *p, *q;
for(y=0; y < src.height(); y++){
q = (unsigned int *)dest.scanLine(y);
for(x=0; x < src.width(); x++){
x_distance = x + ((rand() % (amount+1))-quantum);
y_distance = y + ((rand() % (amount+1))-quantum);
x_distance = QMIN(x_distance, src.width()-1);
y_distance = QMIN(y_distance, src.height()-1);
if(x_distance < 0)
x_distance = 0;
if(y_distance < 0)
y_distance = 0;
p = (unsigned int *)src.scanLine(y_distance);
p += x_distance;
*q++=(*p);
}
}
}
/*else { // PsudeoClass source image
// just do colortable values
unsigned char *p, *q;
for(y=0; y < src.height(); y++){
q = (unsigned char *)dest.scanLine(y);
for(x=0; x < src.width(); x++){
x_distance = x + ((rand() & (amount+1))-quantum);
y_distance = y + ((rand() & (amount+1))-quantum);
x_distance = QMIN(x_distance, src.width()-1);
y_distance = QMIN(y_distance, src.height()-1);
if(x_distance < 0)
x_distance = 0;
if(y_distance < 0)
y_distance = 0;
p = (unsigned char *)src.scanLine(y_distance);
p += x_distance;
*q++=(*p);
}
}
}*/
return(dest);
}
QImage KImageEffect::swirl(QImage &src, double degrees,
unsigned int background)
{
double cosine, distance, factor, radius, sine, x_center, x_distance,
x_scale, y_center, y_distance, y_scale;
int x, y;
unsigned int *q;
QImage dest(src.width(), src.height(), src.transparent());
// compute scaling factor
x_center = src.width()/2.0;
y_center = src.height()/2.0;
radius = QMAX(x_center,y_center);
x_scale=1.0;
y_scale=1.0;
if(src.width() > src.height())
y_scale=(double)src.width()/src.height();
else if(src.width() < src.height())
x_scale=(double)src.height()/src.width();
//degrees=DegreesToRadians(degrees);
// swirl each row
if(src.depth() > 8){ // DirectClass source image
unsigned int *p;
for(y=0; y < src.height(); y++){
p = (unsigned int *)src.scanLine(y);
q = (unsigned int *)dest.scanLine(y);
y_distance = y_scale*(y-y_center);
for(x=0; x < src.width(); x++){
// determine if the pixel is within an ellipse
*q=(*p);
x_distance = x_scale*(x-x_center);
distance = x_distance*x_distance+y_distance*y_distance;
if (distance < (radius*radius)){
// swirl
factor = 1.0-sqrt(distance)/radius;
sine = sin(degrees*factor*factor);
cosine = cos(degrees*factor*factor);
*q = interpolateColor(&src,
(cosine*x_distance-sine*y_distance)/x_scale+x_center,
(sine*x_distance+cosine*y_distance)/y_scale+y_center,
background);
}
p++;
q++;
}
}
}
/*else{ // PsudeoClass source image
unsigned char *p;
unsigned int *cTable = (unsigned int *)src.colorTable();
for(y=0; y < src.height(); y++){
p = (unsigned char *)src.scanLine(y);
q = (unsigned int *)dest.scanLine(y);
y_distance = y_scale*(y-y_center);
for(x=0; x < src.width(); x++){
// determine if the pixel is within an ellipse
*q = *(cTable+(*p));
x_distance = x_scale*(x-x_center);
distance = x_distance*x_distance+y_distance*y_distance;
if (distance < (radius*radius)){
// swirl
factor = 1.0-sqrt(distance)/radius;
sine = sin(degrees*factor*factor);
cosine = cos(degrees*factor*factor);
*q = interpolateColor(&src,
(cosine*x_distance-sine*y_distance)/x_scale+x_center,
(sine*x_distance+cosine*y_distance)/y_scale+y_center,
background);
}
p++;
q++;
}
}
}*/
return(dest);
}
QImage KImageEffect::wave(QImage &src, double amplitude, double wavelength,
unsigned int background)
{
double *sine_map;
int x, y;
unsigned int *q;
QImage dest(src.width(), src.height() + (int)(2*fabs(amplitude)), src.transparent());
// allocate sine map
sine_map = (double *)malloc(dest.width()*sizeof(double));
if(!sine_map)
return(src);
for(x=0; x < dest.width(); ++x)
sine_map[x]=fabs(amplitude)+amplitude*sin((2*M_PI*x)/wavelength);
// wave image
for(y=0; y < dest.height(); ++y){
q = (unsigned int *)dest.scanLine(y);
for (x=0; x < dest.width(); x++){
*q=interpolateColor(&src, x, (int)(y-sine_map[x]), background);
++q;
}
}
free(sine_map);
return(dest);
}
//
// The following methods work by computing a value from neighboring pixels
// (mosfet 05/26/03)
//
// New algorithms based on ImageMagick 5.5.6 (05/26/03)
#if 0
QImage KImageEffect::oilPaint(QImage &src, int /*radius*/)
{
/* binary compat method - remove me when possible! */
return(oilPaintConvolve(src, 0));
}
#endif
QImage KImageEffect::oilPaintConvolve(QImage &src, double radius)
{
unsigned long count /*,*histogram*/;
unsigned long histogram[256];
unsigned int k;
int width;
int x, y, mx, my, sx, sy;
int mcx, mcy;
unsigned int *s=0, *q;
//if(src.depth() < 32)
// src.convertDepth(32);
QImage dest(src.width(), src.height(), src.transparent());
width = getOptimalKernelWidth(radius, 0.5);
if(src.width() < width || width <= 0) {
//qWarning("KImageEffect::oilPaintConvolve(): Image is smaller than radius!");
return(dest);
}
/*
histogram = (unsigned long *)malloc(256*sizeof(unsigned long));
if(!histogram){
qWarning("KImageEffect::oilPaintColvolve(): Unable to allocate memory!");
return(dest);
}
*/
unsigned int **jumpTable = (unsigned int **)src.jumpTable();
for(y=0; y < dest.height(); ++y){
sy = y-(width/2);
q = (unsigned int *)dest.scanLine(y);
for(x=0; x < dest.width(); ++x){
count = 0;
memset(histogram, 0, 256*sizeof(unsigned long));
//memset(histogram, 0, 256);
sy = y-(width/2);
for(mcy=0; mcy < width; ++mcy, ++sy){
my = sy < 0 ? 0 : sy > src.height()-1 ?
src.height()-1 : sy;
sx = x+(-width/2);
for(mcx=0; mcx < width; ++mcx, ++sx){
mx = sx < 0 ? 0 : sx > src.width()-1 ?
src.width()-1 : sx;
k = intensityValue(jumpTable[my][mx]);
if(k > 255){
//qWarning("KImageEffect::oilPaintConvolve(): k is %d",
// k);
k = 255;
}
histogram[k]++;
if(histogram[k] > count){
count = histogram[k];
s = jumpTable[my]+mx;
}
}
}
*q++ = (*s);
}
}
/* liberateMemory(histogram); */
return(dest);
}
#if 0
QImage KImageEffect::charcoal(QImage &src, double /*factor*/)
{
/* binary compat method - remove me when possible! */
return(charcoal(src, 0, 1));
}
#endif
QImage KImageEffect::charcoal(QImage &src, double radius, double sigma)
{
QImage img0 = edge(src, radius);
QImage img = blur(img0, radius, sigma);
img0.release();
normalize(img);
img.invertPixels();
KImageEffect::toGray(img);
return(img);
}
void KImageEffect::normalize(QImage &image)
{
struct double_packet high, low, intensity, *histogram;
struct short_packet *normalize_map;
long long number_pixels;
int x, y;
unsigned int *p, *q;
register long i;
unsigned long threshold_intensity;
unsigned char r, g, b, a;
//if(image.depth() < 32) // result will always be 32bpp
// image = image.convertDepth(32);
histogram = (struct double_packet *)
malloc(256*sizeof(struct double_packet));
normalize_map = (struct short_packet *)
malloc(256*sizeof(struct short_packet));
if(!histogram || !normalize_map){
if(histogram)
liberateMemory( &histogram);
if(normalize_map)
liberateMemory( &normalize_map);
//qWarning("KImageEffect::normalize(): Unable to allocate memory!");
return;
}
/*
Form histogram.
*/
memset(histogram, 0, 256*sizeof(struct double_packet));
for(y=0; y < image.height(); ++y){
p = (unsigned int *)image.scanLine(y);
for(x=0; x < image.width(); ++x){
histogram[(unsigned char)(qRed(*p))].red++;
histogram[(unsigned char)(qGreen(*p))].green++;
histogram[(unsigned char)(qBlue(*p))].blue++;
histogram[(unsigned char)(qAlpha(*p))].alpha++;
p++;
}
}
/*
Find the histogram boundaries by locating the 0.1 percent levels.
*/
number_pixels = (long long)image.width()*image.height();
threshold_intensity = number_pixels/1000;
memset(&high, 0, sizeof(struct double_packet));
memset(&low, 0, sizeof(struct double_packet));
/* red */
memset(&intensity, 0, sizeof(struct double_packet));
for(high.red=255; high.red != 0; high.red--){
intensity.red+=histogram[(unsigned char)high.red].red;
if(intensity.red > threshold_intensity)
break;
}
if(low.red == high.red){
threshold_intensity = 0;
memset(&intensity, 0, sizeof(struct double_packet));
for(low.red=0; low.red < 255; low.red++){
intensity.red+=histogram[(unsigned char)low.red].red;
if(intensity.red > threshold_intensity)
break;
}
memset(&intensity, 0, sizeof(struct double_packet));
for(high.red=255; high.red != 0; high.red--){
intensity.red+=histogram[(unsigned char)high.red].red;
if(intensity.red > threshold_intensity)
break;
}
}
/* green */
memset(&intensity, 0, sizeof(struct double_packet));
for(high.green=255; high.green != 0; high.green--){
intensity.green+=histogram[(unsigned char)high.green].green;
if(intensity.green > threshold_intensity)
break;
}
if(low.green == high.green){
threshold_intensity = 0;
memset(&intensity, 0, sizeof(struct double_packet));
for(low.green=0; low.green < 255; low.green++){
intensity.green+=histogram[(unsigned char)low.green].green;
if(intensity.green > threshold_intensity)
break;
}
memset(&intensity,0,sizeof(struct double_packet));
for(high.green=255; high.green != 0; high.green--){
intensity.green+=histogram[(unsigned char)high.green].green;
if(intensity.green > threshold_intensity)
break;
}
}
/* blue */
memset(&intensity, 0, sizeof(struct double_packet));
for(high.blue=255; high.blue != 0; high.blue--){
intensity.blue+=histogram[(unsigned char)high.blue].blue;
if(intensity.blue > threshold_intensity)
break;
}
if(low.blue == high.blue){
threshold_intensity = 0;
memset(&intensity, 0, sizeof(struct double_packet));
for(low.blue=0; low.blue < 255; low.blue++){
intensity.blue+=histogram[(unsigned char)low.blue].blue;
if(intensity.blue > threshold_intensity)
break;
}
memset(&intensity,0,sizeof(struct double_packet));
for(high.blue=255; high.blue != 0; high.blue--){
intensity.blue+=histogram[(unsigned char)high.blue].blue;
if(intensity.blue > threshold_intensity)
break;
}
}
/* alpha */
memset(&intensity, 0, sizeof(struct double_packet));
for(high.alpha=255; high.alpha != 0; high.alpha--){
intensity.alpha+=histogram[(unsigned char)high.alpha].alpha;
if(intensity.alpha > threshold_intensity)
break;
}
if(low.alpha == high.alpha){
threshold_intensity = 0;
memset(&intensity, 0, sizeof(struct double_packet));
for(low.alpha=0; low.alpha < 255; low.alpha++){
intensity.alpha+=histogram[(unsigned char)low.alpha].alpha;
if(intensity.alpha > threshold_intensity)
break;
}
memset(&intensity,0,sizeof(struct double_packet));
for(high.alpha=255; high.alpha != 0; high.alpha--){
intensity.alpha+=histogram[(unsigned char)high.alpha].alpha;
if(intensity.alpha > threshold_intensity)
break;
}
}
liberateMemory( &histogram);
/*
Stretch the histogram to create the normalized image mapping.
*/
// should the maxes be 65535?
memset(normalize_map, 0 ,256*sizeof(struct short_packet));
for(i=0; i <= (long) 255; i++){
if(i < (long) low.red)
normalize_map[i].red=0;
else if (i > (long) high.red)
normalize_map[i].red=65535;
else if (low.red != high.red)
normalize_map[i].red =
(unsigned short)((65535*(i-low.red))/(high.red-low.red));
if(i < (long) low.green)
normalize_map[i].green=0;
else if (i > (long) high.green)
normalize_map[i].green=65535;
else if (low.green != high.green)
normalize_map[i].green =
(unsigned short)((65535*(i-low.green))/(high.green-low.green));
if(i < (long) low.blue)
normalize_map[i].blue=0;
else if (i > (long) high.blue)
normalize_map[i].blue=65535;
else if (low.blue != high.blue)
normalize_map[i].blue =
(unsigned short)((65535*(i-low.blue))/(high.blue-low.blue));
if(i < (long) low.alpha)
normalize_map[i].alpha=0;
else if (i > (long) high.alpha)
normalize_map[i].alpha=65535;
else if (low.alpha != high.alpha)
normalize_map[i].alpha =
(unsigned short)((65535*(i-low.alpha))/(high.alpha-low.alpha));
}
for(y=0; y < image.height(); ++y){
q = (unsigned int *)image.scanLine(y);
for(x=0; x < image.width(); ++x){
if(low.red != high.red)
r = (normalize_map[(unsigned short)(qRed(q[x]))].red)/257;
else
r = qRed(q[x]);
if(low.green != high.green)
g = (normalize_map[(unsigned short)(qGreen(q[x]))].green)/257;
else
g = qGreen(q[x]);
if(low.blue != high.blue)
b = (normalize_map[(unsigned short)(qBlue(q[x]))].blue)/257;
else
b = qBlue(q[x]);
if(low.alpha != high.alpha)
a = (normalize_map[(unsigned short)(qAlpha(q[x]))].alpha)/257;
else
a = qAlpha(q[x]);
q[x] = qRgba(r, g, b, a);
}
}
liberateMemory( &normalize_map);
}
void KImageEffect::equalize(QImage &image)
{
struct double_packet high, low, intensity, *map, *histogram;
struct short_packet *equalize_map;
int x, y;
unsigned int *p, *q;
long i;
unsigned char r, g, b, a;
//if(image.depth() < 32) // result will always be 32bpp
// image = image.convertDepth(32);
histogram=(struct double_packet *) malloc(256*sizeof(struct double_packet));
map=(struct double_packet *) malloc(256*sizeof(struct double_packet));
equalize_map=(struct short_packet *)malloc(256*sizeof(struct short_packet));
if(!histogram || !map || !equalize_map){
if(histogram)
liberateMemory( &histogram);
if(map)
liberateMemory( &map);
if(equalize_map)
liberateMemory( &equalize_map);
//qWarning("KImageEffect::equalize(): Unable to allocate memory!");
return;
}
/*
Form histogram.
*/
memset(histogram, 0, 256*sizeof(struct double_packet));
for(y=0; y < image.height(); ++y){
p = (unsigned int *)image.scanLine(y);
for(x=0; x < image.width(); ++x){
histogram[(unsigned char)(qRed(*p))].red++;
histogram[(unsigned char)(qGreen(*p))].green++;
histogram[(unsigned char)(qBlue(*p))].blue++;
histogram[(unsigned char)(qAlpha(*p))].alpha++;
p++;
}
}
/*
Integrate the histogram to get the equalization map.
*/
memset(&intensity, 0 ,sizeof(struct double_packet));
for(i=0; i <= 255; ++i){
intensity.red += histogram[i].red;
intensity.green += histogram[i].green;
intensity.blue += histogram[i].blue;
intensity.alpha += histogram[i].alpha;
map[i]=intensity;
}
low=map[0];
high=map[255];
memset(equalize_map, 0, 256*sizeof(short_packet));
for(i=0; i <= 255; ++i){
if(high.red != low.red)
equalize_map[i].red=(unsigned short)
((65535*(map[i].red-low.red))/(high.red-low.red));
if(high.green != low.green)
equalize_map[i].green=(unsigned short)
((65535*(map[i].green-low.green))/(high.green-low.green));
if(high.blue != low.blue)
equalize_map[i].blue=(unsigned short)
((65535*(map[i].blue-low.blue))/(high.blue-low.blue));
if(high.alpha != low.alpha)
equalize_map[i].alpha=(unsigned short)
((65535*(map[i].alpha-low.alpha))/(high.alpha-low.alpha));
}
liberateMemory( &histogram);
liberateMemory( &map);
/*
Stretch the histogram.
*/
for(y=0; y < image.height(); ++y){
q = (unsigned int *)image.scanLine(y);
for(x=0; x < image.width(); ++x){
if(low.red != high.red)
r = (equalize_map[(unsigned short)(qRed(q[x]))].red/257);
else
r = qRed(q[x]);
if(low.green != high.green)
g = (equalize_map[(unsigned short)(qGreen(q[x]))].green/257);
else
g = qGreen(q[x]);
if(low.blue != high.blue)
b = (equalize_map[(unsigned short)(qBlue(q[x]))].blue/257);
else
b = qBlue(q[x]);
if(low.alpha != high.alpha)
a = (equalize_map[(unsigned short)(qAlpha(q[x]))].alpha/257);
else
a = qAlpha(q[x]);
q[x] = qRgba(r, g, b, a);
}
}
liberateMemory( &equalize_map);
}
QImage KImageEffect::edge(QImage &image, double radius)
{
double *kernel;
int width;
register long i;
QImage dest;
width = getOptimalKernelWidth(radius, 0.5);
if(image.width() < width || image.height() < width){
//qWarning("KImageEffect::edge(): Image is smaller than radius!");
return(dest);
}
kernel= (double *)malloc(width*width*sizeof(double));
if(!kernel){
//qWarning("KImageEffect::edge(): Unable to allocate memory!");
return(dest);
}
for(i=0; i < (width*width); i++)
kernel[i]=(-1.0);
kernel[i/2]=width*width-1.0;
convolveImage(&image, &dest, width, kernel);
liberateMemory(&kernel);
return(dest);
}
#if 0
QImage KImageEffect::emboss(QImage &src)
{
/* binary compat method - remove me when possible! */
return(emboss(src, 0, 1));
}
#endif
QImage KImageEffect::emboss(QImage &image, double radius, double sigma)
{
double alpha, *kernel;
int j, width;
register long i, u, v;
QImage dest;
if(sigma == 0.0){
//qWarning("KImageEffect::emboss(): Zero sigma is not permitted!");
return(dest);
}
width = getOptimalKernelWidth(radius, sigma);
if(image.width() < width || image.height() < width){
//qWarning("KImageEffect::emboss(): Image is smaller than radius!");
return(dest);
}
kernel= (double *)malloc(width*width*sizeof(double));
if(!kernel){
//qWarning("KImageEffect::emboss(): Unable to allocate memory!");
return(dest);
}
//if(image.depth() < 32)
// image = image.convertDepth(32);
i=0;
j=width/2;
for(v=(-width/2); v <= (width/2); v++){
for(u=(-width/2); u <= (width/2); u++){
alpha=exp(-((double) u*u+v*v)/(2.0*sigma*sigma));
kernel[i]=((u < 0) || (v < 0) ? -8.0 : 8.0)*alpha/
(2.0*MagickPI*sigma*sigma);
if (u == j)
kernel[i]=0.0;
i++;
}
j--;
}
convolveImage(&image, &dest, width, kernel);
liberateMemory(&kernel);
equalize(dest);
return(dest);
}
void KImageEffect::blurScanLine(double *kernel, int width,
unsigned int *src, unsigned int *dest,
int columns)
{
register double *p;
unsigned int *q;
register int x;
register long i;
double red, green, blue, alpha;
double scale = 0.0;
if(width > columns){
for(x=0; x < columns; ++x){
scale = 0.0;
red = blue = green = alpha = 0.0;
p = kernel;
q = src;
for(i=0; i < columns; ++i){
if((i >= (x-width/2)) && (i <= (x+width/2))){
red += (*p)*(qRed(*q)*257);
green += (*p)*(qGreen(*q)*257);
blue += (*p)*(qBlue(*q)*257);
alpha += (*p)*(qAlpha(*q)*257);
}
if(((i+width/2-x) >= 0) && ((i+width/2-x) < width))
scale+=kernel[i+width/2-x];
p++;
q++;
}
scale = 1.0/scale;
red = scale*(red+0.5);
green = scale*(green+0.5);
blue = scale*(blue+0.5);
alpha = scale*(alpha+0.5);
red = red < 0 ? 0 : red > 65535 ? 65535 : red;
green = green < 0 ? 0 : green > 65535 ? 65535 : green;
blue = blue < 0 ? 0 : blue > 65535 ? 65535 : blue;
alpha = alpha < 0 ? 0 : alpha > 65535 ? 65535 : alpha;
dest[x] = qRgba((unsigned char)(red/257UL),
(unsigned char)(green/257UL),
(unsigned char)(blue/257UL),
(unsigned char)(alpha/257UL));
}
return;
}
for(x=0; x < width/2; ++x){
scale = 0.0;
red = blue = green = alpha = 0.0;
p = kernel+width/2-x;
q = src;
for(i=width/2-x; i < width; ++i){
red += (*p)*(qRed(*q)*257);
green += (*p)*(qGreen(*q)*257);
blue += (*p)*(qBlue(*q)*257);
alpha += (*p)*(qAlpha(*q)*257);
scale += (*p);
p++;
q++;
}
scale=1.0/scale;
red = scale*(red+0.5);
green = scale*(green+0.5);
blue = scale*(blue+0.5);
alpha = scale*(alpha+0.5);
red = red < 0 ? 0 : red > 65535 ? 65535 : red;
green = green < 0 ? 0 : green > 65535 ? 65535 : green;
blue = blue < 0 ? 0 : blue > 65535 ? 65535 : blue;
alpha = alpha < 0 ? 0 : alpha > 65535 ? 65535 : alpha;
dest[x] = qRgba((unsigned char)(red/257UL),
(unsigned char)(green/257UL),
(unsigned char)(blue/257UL),
(unsigned char)(alpha/257UL));
}
for(; x < columns-width/2; ++x){
red = blue = green = alpha = 0.0;
p = kernel;
q = src+(x-width/2);
for (i=0; i < (long) width; ++i){
red += (*p)*(qRed(*q)*257);
green += (*p)*(qGreen(*q)*257);
blue += (*p)*(qBlue(*q)*257);
alpha += (*p)*(qAlpha(*q)*257);
p++;
q++;
}
red = scale*(red+0.5);
green = scale*(green+0.5);
blue = scale*(blue+0.5);
alpha = scale*(alpha+0.5);
red = red < 0 ? 0 : red > 65535 ? 65535 : red;
green = green < 0 ? 0 : green > 65535 ? 65535 : green;
blue = blue < 0 ? 0 : blue > 65535 ? 65535 : blue;
alpha = alpha < 0 ? 0 : alpha > 65535 ? 65535 : alpha;
dest[x] = qRgba((unsigned char)(red/257UL),
(unsigned char)(green/257UL),
(unsigned char)(blue/257UL),
(unsigned char)(alpha/257UL));
}
for(; x < columns; ++x){
red = blue = green = alpha = 0.0;
scale=0;
p = kernel;
q = src+(x-width/2);
for(i=0; i < columns-x+width/2; ++i){
red += (*p)*(qRed(*q)*257);
green += (*p)*(qGreen(*q)*257);
blue += (*p)*(qBlue(*q)*257);
alpha += (*p)*(qAlpha(*q)*257);
scale += (*p);
p++;
q++;
}
scale=1.0/scale;
red = scale*(red+0.5);
green = scale*(green+0.5);
blue = scale*(blue+0.5);
alpha = scale*(alpha+0.5);
red = red < 0 ? 0 : red > 65535 ? 65535 : red;
green = green < 0 ? 0 : green > 65535 ? 65535 : green;
blue = blue < 0 ? 0 : blue > 65535 ? 65535 : blue;
alpha = alpha < 0 ? 0 : alpha > 65535 ? 65535 : alpha;
dest[x] = qRgba((unsigned char)(red/257UL),
(unsigned char)(green/257UL),
(unsigned char)(blue/257UL),
(unsigned char)(alpha/257UL));
}
}
int KImageEffect::getBlurKernel(int width, double sigma, double **kernel)
{
#define KernelRank 3
double alpha, normalize;
register long i;
int bias;
assert(sigma != 0.0);
if(width == 0)
width = 3;
*kernel=(double *)malloc(width*sizeof(double));
if(*kernel == (double *)NULL)
return(0);
memset(*kernel, 0, width*sizeof(double));
bias = KernelRank*width/2;
for(i=(-bias); i <= bias; i++){
alpha=exp(-((double) i*i)/(2.0*KernelRank*KernelRank*sigma*sigma));
(*kernel)[(i+bias)/KernelRank]+=alpha/(MagickSQ2PI*sigma);
}
normalize=0;
for(i=0; i < width; i++)
normalize+=(*kernel)[i];
for(i=0; i < width; i++)
(*kernel)[i]/=normalize;
return(width);
}
#if 0
QImage KImageEffect::blur(QImage &src, double /*factor*/)
{
/* binary compat method - remove me when possible! */
return(blur(src, 0, 1));
}
#endif
QImage KImageEffect::blur(QImage &src, double radius, double sigma)
{
double *kernel;
QImage dest;
int width;
int x, y;
unsigned int *scanline, *temp;
unsigned int *p, *q;
if(sigma == 0.0){
//qWarning("KImageEffect::blur(): Zero sigma is not permitted!");
return(dest);
}
//if(src.depth() < 32)
// src = src.convertDepth(32);
kernel=(double *) NULL;
if(radius > 0)
width=getBlurKernel((int) (2*ceil(radius)+1),sigma,&kernel);
else{
double *last_kernel;
last_kernel=(double *) NULL;
width=getBlurKernel(3,sigma,&kernel);
while ((long) (MaxRGB*kernel[0]) > 0){
if(last_kernel != (double *)NULL){
liberateMemory( &last_kernel);
}
last_kernel=kernel;
kernel = (double *)NULL;
width = getBlurKernel(width+2, sigma, &kernel);
}
if(last_kernel != (double *) NULL){
liberateMemory( &kernel);
width-=2;
kernel = last_kernel;
}
}
if(width < 3){
//qWarning("KImageEffect::blur(): Kernel radius is too small!");
liberateMemory( &kernel);
return(dest);
}
dest.create(src.width(), src.height(), src.transparent());
scanline = (unsigned int *)malloc(sizeof(unsigned int)*src.height());
temp = (unsigned int *)malloc(sizeof(unsigned int)*src.height());
for(y=0; y < src.height(); ++y){
p = (unsigned int *)src.scanLine(y);
q = (unsigned int *)dest.scanLine(y);
blurScanLine(kernel, width, p, q, src.width());
}
unsigned int **srcTable = (unsigned int **)src.jumpTable();
unsigned int **destTable = (unsigned int **)dest.jumpTable();
for(x=0; x < src.width(); ++x){
for(y=0; y < src.height(); ++y){
scanline[y] = srcTable[y][x];
}
blurScanLine(kernel, width, scanline, temp, src.height());
for(y=0; y < src.height(); ++y){
destTable[y][x] = temp[y];
}
}
liberateMemory( &scanline);
liberateMemory( &temp);
liberateMemory( &kernel);
return(dest);
}
bool KImageEffect::convolveImage(QImage *image, QImage *dest,
const unsigned int order,
const double *kernel)
{
long width;
double red, green, blue, alpha;
double normalize, *normal_kernel;
register const double *k;
register unsigned int *q;
int x, y, mx, my, sx, sy;
long i;
int mcx, mcy;
width = order;
if((width % 2) == 0){
//qWarning("KImageEffect: Kernel width must be an odd number!");
return(false);
}
normal_kernel = (double *)malloc(width*width*sizeof(double));
if(!normal_kernel){
//qWarning("KImageEffect: Unable to allocate memory!");
return(false);
}
dest->reset();
dest->create(image->width(), image->height(), image->transparent());
//if(image->depth() < 32)
// *image = image->convertDepth(32);
normalize=0.0;
for(i=0; i < (width*width); i++)
normalize += kernel[i];
if(fabs(normalize) <= MagickEpsilon)
normalize=1.0;
normalize=1.0/normalize;
for(i=0; i < (width*width); i++)
normal_kernel[i] = normalize*kernel[i];
unsigned int **jumpTable = (unsigned int **)image->jumpTable();
for(y=0; y < dest->height(); ++y){
sy = y-(width/2);
q = (unsigned int *)dest->scanLine(y);
for(x=0; x < dest->width(); ++x){
k = normal_kernel;
red = green = blue = alpha = 0;
sy = y-(width/2);
for(mcy=0; mcy < width; ++mcy, ++sy){
my = sy < 0 ? 0 : sy > image->height()-1 ?
image->height()-1 : sy;
sx = x+(-width/2);
for(mcx=0; mcx < width; ++mcx, ++sx){
mx = sx < 0 ? 0 : sx > image->width()-1 ?
image->width()-1 : sx;
red += (*k)*(qRed(jumpTable[my][mx])*257);
green += (*k)*(qGreen(jumpTable[my][mx])*257);
blue += (*k)*(qBlue(jumpTable[my][mx])*257);
alpha += (*k)*(qAlpha(jumpTable[my][mx])*257);
++k;
}
}
red = red < 0 ? 0 : red > 65535 ? 65535 : red+0.5;
green = green < 0 ? 0 : green > 65535 ? 65535 : green+0.5;
blue = blue < 0 ? 0 : blue > 65535 ? 65535 : blue+0.5;
alpha = alpha < 0 ? 0 : alpha > 65535 ? 65535 : alpha+0.5;
*q++ = qRgba((unsigned char)(red/257UL),
(unsigned char)(green/257UL),
(unsigned char)(blue/257UL),
(unsigned char)(alpha/257UL));
}
}
free(normal_kernel);
return(true);
}
int KImageEffect::getOptimalKernelWidth(double radius, double sigma)
{
double normalize, value;
long width;
register long u;
assert(sigma != 0.0);
if(radius > 0.0)
return((int)(2.0*ceil(radius)+1.0));
for(width=5; ;){
normalize=0.0;
for(u=(-width/2); u <= (width/2); u++)
normalize+=exp(-((double) u*u)/(2.0*sigma*sigma))/(MagickSQ2PI*sigma);
u=width/2;
value=exp(-((double) u*u)/(2.0*sigma*sigma))/(MagickSQ2PI*sigma)/normalize;
if((long)(65535*value) <= 0)
break;
width+=2;
}
return((int)width-2);
}
#if 0
QImage KImageEffect::sharpen(QImage &src, double /*factor*/)
{
/* binary compat method - remove me when possible! */
return(sharpen(src, 0, 1));
}
#endif
QImage KImageEffect::sharpen(QImage &image, double radius, double sigma)
{
double alpha, normalize, *kernel;
int width;
register long i, u, v;
QImage dest;
if(sigma == 0.0){
//qWarning("KImageEffect::sharpen(): Zero sigma is not permitted!");
return(dest);
}
width = getOptimalKernelWidth(radius, sigma);
if(image.width() < width){
//qWarning("KImageEffect::sharpen(): Image is smaller than radius!");
return(dest);
}
kernel = (double *)malloc(width*width*sizeof(double));
if(!kernel){
//qWarning("KImageEffect::sharpen(): Unable to allocate memory!");
return(dest);
}
i = 0;
normalize=0.0;
for(v=(-width/2); v <= (width/2); v++){
for(u=(-width/2); u <= (width/2); u++){
alpha=exp(-((double) u*u+v*v)/(2.0*sigma*sigma));
kernel[i]=alpha/(2.0*MagickPI*sigma*sigma);
normalize+=kernel[i];
i++;
}
}
kernel[i/2]=(-2.0)*normalize;
convolveImage(&image, &dest, width, kernel);
liberateMemory( &kernel);
return(dest);
}
// End of new algorithms
QImage KImageEffect::shade(QImage &src, bool color_shading, double azimuth,
double elevation)
{
struct PointInfo{
double x, y, z;
};
double distance, normal_distance, shade;
int x, y;
struct PointInfo light, normal;
unsigned int *q;
QImage dest(src.width(), src.height(), src.transparent());
//azimuth = DegreesToRadians(azimuth);
//elevation = DegreesToRadians(elevation);
light.x = MaxRGB*cos(azimuth)*cos(elevation);
light.y = MaxRGB*sin(azimuth)*cos(elevation);
light.z = MaxRGB*sin(elevation);
normal.z= 2*MaxRGB; // constant Z of surface normal
if(src.depth() > 8){ // DirectClass source image
unsigned int *p, *s0, *s1, *s2;
for(y=0; y < src.height(); ++y){
p = (unsigned int *)src.scanLine(QMIN(QMAX(y-1,0),src.height()-3));
q = (unsigned int *)dest.scanLine(y);
// shade this row of pixels.
*q++=(*(p+src.width()));
p++;
s0 = p;
s1 = p + src.width();
s2 = p + 2*src.width();
for(x=1; x < src.width()-1; ++x){
// determine the surface normal and compute shading.
normal.x=intensityValue(*(s0-1))+intensityValue(*(s1-1))+intensityValue(*(s2-1))-
(double) intensityValue(*(s0+1))-(double) intensityValue(*(s1+1))-
(double) intensityValue(*(s2+1));
normal.y=intensityValue(*(s2-1))+intensityValue(*s2)+intensityValue(*(s2+1))-
(double) intensityValue(*(s0-1))-(double) intensityValue(*s0)-
(double) intensityValue(*(s0+1));
if((normal.x == 0) && (normal.y == 0))
shade=light.z;
else{
shade=0.0;
distance=normal.x*light.x+normal.y*light.y+normal.z*light.z;
if (distance > 0.0){
normal_distance=
normal.x*normal.x+normal.y*normal.y+normal.z*normal.z;
if(fabs(normal_distance) > 0.0000001)
shade=distance/sqrt(normal_distance);
}
}
if(!color_shading){
*q = qRgba((unsigned char)(shade),
(unsigned char)(shade),
(unsigned char)(shade),
qAlpha(*s1));
}
else{
*q = qRgba((unsigned char)((shade*qRed(*s1))/(MaxRGB+1)),
(unsigned char)((shade*qGreen(*s1))/(MaxRGB+1)),
(unsigned char)((shade*qBlue(*s1))/(MaxRGB+1)),
qAlpha(*s1));
}
++s0;
++s1;
++s2;
q++;
}
*q++=(*s1);
}
}/*
else{ // PsudeoClass source image
unsigned char *p, *s0, *s1, *s2;
int scanLineIdx;
unsigned int *cTable = (unsigned int *)src.colorTable();
for(y=0; y < src.height(); ++y){
scanLineIdx = QMIN(QMAX(y-1,0),src.height()-3);
p = (unsigned char *)src.scanLine(scanLineIdx);
q = (unsigned int *)dest.scanLine(y);
// shade this row of pixels.
s0 = p;
s1 = (unsigned char *) src.scanLine(scanLineIdx+1);
s2 = (unsigned char *) src.scanLine(scanLineIdx+2);
*q++=(*(cTable+(*s1)));
++p;
++s0;
++s1;
++s2;
for(x=1; x < src.width()-1; ++x){
// determine the surface normal and compute shading.
normal.x=intensityValue(*(cTable+(*(s0-1))))+intensityValue(*(cTable+(*(s1-1))))+intensityValue(*(cTable+(*(s2-1))))-
(double) intensityValue(*(cTable+(*(s0+1))))-(double) intensityValue(*(cTable+(*(s1+1))))-
(double) intensityValue(*(cTable+(*(s2+1))));
normal.y=intensityValue(*(cTable+(*(s2-1))))+intensityValue(*(cTable+(*s2)))+intensityValue(*(cTable+(*(s2+1))))-
(double) intensityValue(*(cTable+(*(s0-1))))-(double) intensityValue(*(cTable+(*s0)))-
(double) intensityValue(*(cTable+(*(s0+1))));
if((normal.x == 0) && (normal.y == 0))
shade=light.z;
else{
shade=0.0;
distance=normal.x*light.x+normal.y*light.y+normal.z*light.z;
if (distance > 0.0){
normal_distance=
normal.x*normal.x+normal.y*normal.y+normal.z*normal.z;
if(fabs(normal_distance) > 0.0000001)
shade=distance/sqrt(normal_distance);
}
}
if(!color_shading){
*q = qRgba((unsigned char)(shade),
(unsigned char)(shade),
(unsigned char)(shade),
qAlpha(*(cTable+(*s1))));
}
else{
*q = qRgba((unsigned char)((shade*qRed(*(cTable+(*s1))))/(MaxRGB+1)),
(unsigned char)((shade*qGreen(*(cTable+(*s1))))/(MaxRGB+1)),
(unsigned char)((shade*qBlue(*(cTable+(*s1))))/(MaxRGB+1)),
qAlpha(*s1));
}
++s0;
++s1;
++s2;
q++;
}
*q++=(*(cTable+(*s1)));
}
}*/
return(dest);
}
#if 0
// High quality, expensive HSV contrast. You can do a faster one by just
// taking a grayscale threshold (ie: 128) and incrementing RGB color
// channels above it and decrementing those below it, but this gives much
// better results. (mosfet 12/28/01)
void KImageEffect::contrastHSV(QImage &image, bool sharpen)
{
int i, sign;
unsigned int *data;
int count;
double brightness, scale, theta;
QColor c;
int h, s, v;
uint col;
sign = sharpen ? 1 : -1;
scale=0.5000000000000001;
if(image.depth() > 8){
count = image.width()*image.height();
data = (unsigned int *)image.bits();
}
else{
count = image.numColors();
data = (unsigned int *)image.colorTable();
}
for(i=0; i < count; ++i){
col = data[i];
INVERT(col);
c.setRgb(data[i]);
c.hsv(&h, &s, &v);
brightness = v/255.0;
theta=(brightness-0.5)*M_PI;
brightness+=scale*(((scale*((sin(theta)+1.0)))-brightness)*sign);
if (brightness > 1.0)
brightness=1.0;
else
if (brightness < 0)
brightness=0.0;
v = (int)(brightness*255);
c.setHsv(h, s, v);
data[i] = qRgba(c.red(), c.green(), c.blue(), qAlpha(data[i]));
INVERT(data[i]);
}
}
struct BumpmapParams {
BumpmapParams( double bm_azimuth, double bm_elevation,
int bm_depth, KImageEffect::BumpmapType bm_type,
bool invert ) {
/* Convert to radians */
double azimuth = DegreesToRadians( bm_azimuth );
double elevation = DegreesToRadians( bm_elevation );
/* Calculate the light vector */
lx = (int)( cos(azimuth) * cos(elevation) * 255.0 );
ly = (int)( sin(azimuth) * cos(elevation) * 255.0 );
int lz = (int)( sin(elevation) * 255.0 );
/* Calculate constant Z component of surface normal */
int nz = (6 * 255) / bm_depth;
nz2 = nz * nz;
nzlz = nz * lz;
/* Optimize for vertical normals */
background = lz;
/* Calculate darkness compensation factor */
compensation = sin(elevation);
/* Create look-up table for map type */
for (int i = 0; i < 256; i++)
{
double n = 0;
switch (bm_type)
{
case KImageEffect::Spherical:
n = i / 255.0 - 1.0;
lut[i] = (int) (255.0 * sqrt(1.0 - n * n) + 0.5);
break;
case KImageEffect::Sinuosidal:
n = i / 255.0;
lut[i] = (int) (255.0 * (sin((-M_PI / 2.0) + M_PI * n) + 1.0) /
2.0 + 0.5);
break;
case KImageEffect::Linear:
default:
lut[i] = i;
}
if (invert)
lut[i] = 255 - lut[i];
}
}
int lx, ly;
int nz2, nzlz;
int background;
double compensation;
uchar lut[256];
};
static void bumpmap_convert_row( uint *row,
int width,
int bpp,
int has_alpha,
uchar *lut,
int waterlevel )
{
uint *p;
p = row;
has_alpha = has_alpha ? 1 : 0;
if (bpp >= 3)
for (; width; width--)
{
if (has_alpha) {
unsigned int idx = (unsigned int)(intensityValue( *row ) + 0.5);
*p++ = lut[(unsigned int) ( waterlevel +
( ( idx -
waterlevel) * qBlue( *row )) / 255.0 )];
} else {
unsigned int idx = (unsigned int)(intensityValue( *row ) + 0.5);
*p++ = lut[idx];
}
++row;
}
}
static void bumpmap_row( uint *src,
uint *dest,
int width,
int bpp,
int has_alpha,
uint *bm_row1,
uint *bm_row2,
uint *bm_row3,
int bm_width,
int bm_xofs,
bool tiled,
bool row_in_bumpmap,
int ambient,
bool compensate,
BumpmapParams *params )
{
int xofs1, xofs2, xofs3;
int shade;
int ndotl;
int nx, ny;
int x;
int tmp;
tmp = bm_xofs;
xofs2 = MOD(tmp, bm_width);
for (x = 0; x < width; x++)
{
/* Calculate surface normal from bump map */
if (tiled || (row_in_bumpmap &&
x >= - tmp && x < - tmp + bm_width)) {
if (tiled) {
xofs1 = MOD(xofs2 - 1, bm_width);
xofs3 = MOD(xofs2 + 1, bm_width);
} else {
xofs1 = FXCLAMP(xofs2 - 1, 0, bm_width - 1);
xofs3 = FXCLAMP(xofs2 + 1, 0, bm_width - 1);
}
nx = (bm_row1[xofs1] + bm_row2[xofs1] + bm_row3[xofs1] -
bm_row1[xofs3] - bm_row2[xofs3] - bm_row3[xofs3]);
ny = (bm_row3[xofs1] + bm_row3[xofs2] + bm_row3[xofs3] -
bm_row1[xofs1] - bm_row1[xofs2] - bm_row1[xofs3]);
} else {
nx = ny = 0;
}
/* Shade */
if ((nx == 0) && (ny == 0))
shade = params->background;
else {
ndotl = nx * params->lx + ny * params->ly + params->nzlz;
if (ndotl < 0)
shade = (int)( params->compensation * ambient );
else {
shade = (int)( ndotl / sqrt(double(nx * nx + ny * ny + params->nz2)) );
shade = (int)( shade + QMAX(0.0, (255 * params->compensation - shade)) *
ambient / 255 );
}
}
/* Paint */
/**
* NOTE: if we want to work with non-32bit images the alpha handling would
* also change
*/
if (compensate) {
int red = (int)((qRed( *src ) * shade) / (params->compensation * 255));
int green = (int)((qGreen( *src ) * shade) / (params->compensation * 255));
int blue = (int)((qBlue( *src ) * shade) / (params->compensation * 255));
int alpha = (int)((qAlpha( *src ) * shade) / (params->compensation * 255));
++src;
*dest++ = qRgba( red, green, blue, alpha );
} else {
int red = qRed( *src ) * shade / 255;
int green = qGreen( *src ) * shade / 255;
int blue = qBlue( *src ) * shade / 255;
int alpha = qAlpha( *src ) * shade / 255;
++src;
*dest++ = qRgba( red, green, blue, alpha );
}
/* Next pixel */
if (++xofs2 == bm_width)
xofs2 = 0;
}
}
/**
* A bumpmapping algorithm.
*
* @param img the image you want bumpmap
* @param map the map used
* @param azimuth azimuth
* @param elevation elevation
* @param depth depth (not the depth of the image, but of the map)
* @param xofs X offset
* @param yofs Y offset
* @param waterlevel level that full transparency should represent
* @param ambient ambient lighting factor
* @param compensate compensate for darkening
* @param invert invert bumpmap
* @param type type of the bumpmap
*
* @return The destination image (dst) containing the result.
* @author Zack Rusin <zack@kde.org>
*/
QImage KImageEffect::bumpmap(QImage &img, QImage &map, double azimuth, double elevation,
int depth, int xofs, int yofs, int waterlevel,
int ambient, bool compensate, bool invert,
BumpmapType type, bool tiled)
{
QImage dst;
if ( img.depth() != 32 || img.depth() != 32 ) {
qWarning( "Bump-mapping effect works only with 32 bit images");
return dst;
}
dst.create( img.width(), img.height(), img.depth() );
int bm_width = map.width();
int bm_height = map.height();
int bm_bpp = map.depth();
int bm_has_alpha = map.hasAlphaBuffer();
int yofs1, yofs2, yofs3;
if ( tiled ) {
yofs2 = MOD( yofs, bm_height );
yofs1 = MOD( yofs2 - 1, bm_height);
yofs3 = MOD( yofs2 + 1, bm_height);
} else {
yofs1 = 0;
yofs2 = 0;
yofs3 = FXCLAMP( yofs2+1, 0, bm_height - 1 );
}
BumpmapParams params( azimuth, elevation, depth, type, invert );
uint* bm_row1 = (unsigned int*)map.scanLine( yofs1 );
uint* bm_row2 = (unsigned int*)map.scanLine( yofs2 );
uint* bm_row3 = (unsigned int*)map.scanLine( yofs3 );
bumpmap_convert_row( bm_row1, bm_width, bm_bpp, bm_has_alpha, params.lut, waterlevel );
bumpmap_convert_row( bm_row2, bm_width, bm_bpp, bm_has_alpha, params.lut, waterlevel );
bumpmap_convert_row( bm_row3, bm_width, bm_bpp, bm_has_alpha, params.lut, waterlevel );
for (int y = 0; y < img.height(); ++y)
{
int row_in_bumpmap = (y >= - yofs && y < - yofs + bm_height);
uint* src_row = (unsigned int*)img.scanLine( y );
uint* dest_row = (unsigned int*)dst.scanLine( y );
bumpmap_row( src_row, dest_row, img.width(), img.depth(), img.hasAlphaBuffer(),
bm_row1, bm_row2, bm_row3, bm_width, xofs,
tiled,
row_in_bumpmap, ambient, compensate,
&params );
/* Next line */
if (tiled || row_in_bumpmap)
{
uint* bm_tmprow = bm_row1;
bm_row1 = bm_row2;
bm_row2 = bm_row3;
bm_row3 = bm_tmprow;
if (++yofs2 == bm_height)
yofs2 = 0;
if (tiled)
yofs3 = MOD(yofs2 + 1, bm_height);
else
yofs3 = FXCLAMP(yofs2 + 1, 0, bm_height - 1);
bm_row3 = (unsigned int*)map.scanLine( yofs3 );
bumpmap_convert_row( bm_row3, bm_width, bm_bpp, bm_has_alpha,
params.lut, waterlevel );
}
}
return dst;
}
#endif