#define INKSCAPE_LPE_LATTICE_CPP

#include "live_effects/lpe-lattice.h"

#include "sp-shape.h"

#include "sp-item.h"

#include "sp-path.h"

#include "display/curve.h"

#include "libnr/n-art-bpath-2geom.h"

#include "svg/svg.h"

#include <2geom/sbasis.h>

#include <2geom/sbasis-2d.h>

#include <2geom/sbasis-geometric.h>

#include <2geom/bezier-to-sbasis.h>

#include <2geom/sbasis-to-bezier.h>

#include <2geom/d2.h>

#include <2geom/piecewise.h>

#include <2geom/transforms.h>

using namespace Geom;

namespace Inkscape {

namespace LivePathEffect {

LPELattice::LPELattice(LivePathEffectObject *lpeobject) :

Effect(lpeobject),

// initialise your parameters here:

grid_point0(_("Control handle 0"), _("Tadah"), "gridpoint0", &wr, this),

grid_point1(_("Control handle 1"), _("Tadah"), "gridpoint1", &wr, this),

grid_point2(_("Control handle 2"), _("Tadah"), "gridpoint2", &wr, this),

grid_point3(_("Control handle 3"), _("Tadah"), "gridpoint3", &wr, this),

grid_point4(_("Control handle 4"), _("Tadah"), "gridpoint4", &wr, this),

grid_point5(_("Control handle 5"), _("Tadah"), "gridpoint5", &wr, this),

grid_point6(_("Control handle 6"), _("Tadah"), "gridpoint6", &wr, this),

grid_point7(_("Control handle 7"), _("Tadah"), "gridpoint7", &wr, this),

grid_point8(_("Control handle 8"), _("Tadah"), "gridpoint8", &wr, this),

grid_point9(_("Control handle 9"), _("Tadah"), "gridpoint9", &wr, this),

grid_point10(_("Control handle 10"), _("Tadah"), "gridpoint10", &wr, this),

grid_point11(_("Control handle 11"), _("Tadah"), "gridpoint11", &wr, this),

grid_point12(_("Control handle 12"), _("Tadah"), "gridpoint12", &wr, this),

grid_point13(_("Control handle 13"), _("Tadah"), "gridpoint13", &wr, this),

grid_point14(_("Control handle 14"), _("Tadah"), "gridpoint14", &wr, this),

grid_point15(_("Control handle 15"), _("Tadah"), "gridpoint15", &wr, this)

{

// register all your parameters here, so Inkscape knows which parameters this effect has:

registerParameter( dynamic_cast<Parameter *>(&grid_point0) );

registerParameter( dynamic_cast<Parameter *>(&grid_point1) );

registerParameter( dynamic_cast<Parameter *>(&grid_point2) );

registerParameter( dynamic_cast<Parameter *>(&grid_point3) );

registerParameter( dynamic_cast<Parameter *>(&grid_point4) );

registerParameter( dynamic_cast<Parameter *>(&grid_point5) );

registerParameter( dynamic_cast<Parameter *>(&grid_point6) );

registerParameter( dynamic_cast<Parameter *>(&grid_point7) );

registerParameter( dynamic_cast<Parameter *>(&grid_point8) );

registerParameter( dynamic_cast<Parameter *>(&grid_point9) );

registerParameter( dynamic_cast<Parameter *>(&grid_point10) );

registerParameter( dynamic_cast<Parameter *>(&grid_point11) );

registerParameter( dynamic_cast<Parameter *>(&grid_point12) );

registerParameter( dynamic_cast<Parameter *>(&grid_point13) );

registerParameter( dynamic_cast<Parameter *>(&grid_point14) );

registerParameter( dynamic_cast<Parameter *>(&grid_point15) );

}

LPELattice::~LPELattice()

{

}

Geom::Piecewise<Geom::D2<Geom::SBasis> >

LPELattice::doEffect_pwd2 (Geom::Piecewise<Geom::D2<Geom::SBasis> > const & pwd2_in)

{

D2<SBasis2d> sb2;

//Initialisation of the sb2

for(unsigned dim = 0; dim < 2; dim++) {

sb2[dim].us = 2;

sb2[dim].vs = 2;

const int depth = sb2[dim].us*sb2[dim].vs;

sb2[dim].resize(depth, Linear2d(0));

}

//Grouping the point params in a convenient vector

std::vector<Geom::Point *> handles(16);

handles[0] = &grid_point0;

handles[1] = &grid_point1;

handles[2] = &grid_point2;

handles[3] = &grid_point3;

handles[4] = &grid_point4;

handles[5] = &grid_point5;

handles[6] = &grid_point6;

handles[7] = &grid_point7;

handles[8] = &grid_point8;

handles[9] = &grid_point9;

handles[10] = &grid_point10;

handles[11] = &grid_point11;

handles[12] = &grid_point12;

handles[13] = &grid_point13;

handles[14] = &grid_point14;

handles[15] = &grid_point15;

Geom::Point origin = Geom::Point(boundingbox_X.min(),boundingbox_Y.min());

double width = boundingbox_X.extent();

double height = boundingbox_Y.extent();

//numbering is based on 4 rectangles.

for(unsigned dim = 0; dim < 2; dim++) {

Geom::Point dir(0,0);

dir[dim] = 1;

for(unsigned vi = 0; vi < sb2[dim].vs; vi++) {

for(unsigned ui = 0; ui < sb2[dim].us; ui++) {

for(unsigned iv = 0; iv < 2; iv++) {

for(unsigned iu = 0; iu < 2; iu++) {

unsigned corner = iu + 2*iv;

unsigned i = ui + vi*sb2[dim].us;

//This is the offset from the Upperleft point

Geom::Point base( (ui + iu*(3-2*ui))*width/3.,

(vi + iv*(3-2*vi))*height/3.);

//Special action for corners

if(vi == 0 && ui == 0) {

base = Geom::Point(0,0);

}

// i = Upperleft corner of the considerated rectangle

// corner = actual corner of the rectangle

// origin = Upperleft point

double dl = dot((*handles[corner+4*i] - (base + origin)), dir)/dot(dir,dir);

sb2[dim][i][corner] = dl/( dim ? height : width )*pow(4.0,ui+vi);

}

}

}

}

}

Piecewise<D2<SBasis> > output;

output.push_cut(0.);

for(unsigned i = 0; i < pwd2_in.size(); i++) {

D2<SBasis> B = pwd2_in[i];

B -= origin;

B*= 1/width;

//Here comes the magic

D2<SBasis> tB = compose_each(sb2,B);

tB = tB * width + origin;

output.push(tB,i+1);

}

return output;

}

LPELattice::doBeforeEffect (SPLPEItem *lpeitem)

{

original_bbox(lpeitem);

}

LPELattice::resetDefaults(SPItem * item)

{

original_bbox(SP_LPE_ITEM(item), false);

// place the 16 control points

grid_point0[Geom::X] = boundingbox_X.min();

grid_point0[Geom::Y] = boundingbox_Y.min();

grid_point1[Geom::X] = boundingbox_X.max();

grid_point1[Geom::Y] = boundingbox_Y.min();

grid_point2[Geom::X] = boundingbox_X.min();

grid_point2[Geom::Y] = boundingbox_Y.max();

grid_point3[Geom::X] = boundingbox_X.max();

grid_point3[Geom::Y] = boundingbox_Y.max();

grid_point4[Geom::X] = 1.0/3*boundingbox_X.max()+2.0/3*boundingbox_X.min();

grid_point4[Geom::Y] = boundingbox_Y.min();

grid_point5[Geom::X] = 2.0/3*boundingbox_X.max()+1.0/3*boundingbox_X.min();

grid_point5[Geom::Y] = boundingbox_Y.min();

grid_point6[Geom::X] = 1.0/3*boundingbox_X.max()+2.0/3*boundingbox_X.min();

grid_point6[Geom::Y] = boundingbox_Y.max();

grid_point7[Geom::X] = 2.0/3*boundingbox_X.max()+1.0/3*boundingbox_X.min();

grid_point7[Geom::Y] = boundingbox_Y.max();

grid_point8[Geom::X] = boundingbox_X.min();

grid_point8[Geom::Y] = 1.0/3*boundingbox_Y.max()+2.0/3*boundingbox_Y.min();

grid_point9[Geom::X] = boundingbox_X.max();

grid_point9[Geom::Y] = 1.0/3*boundingbox_Y.max()+2.0/3*boundingbox_Y.min();

grid_point10[Geom::X] = boundingbox_X.min();

grid_point10[Geom::Y] = 2.0/3*boundingbox_Y.max()+1.0/3*boundingbox_Y.min();

grid_point11[Geom::X] = boundingbox_X.max();

grid_point11[Geom::Y] = 2.0/3*boundingbox_Y.max()+1.0/3*boundingbox_Y.min();

grid_point12[Geom::X] = 1.0/3*boundingbox_X.max()+2.0/3*boundingbox_X.min();

grid_point12[Geom::Y] = 1.0/3*boundingbox_Y.max()+2.0/3*boundingbox_Y.min();

grid_point13[Geom::X] = 2.0/3*boundingbox_X.max()+1.0/3*boundingbox_X.min();

grid_point13[Geom::Y] = 1.0/3*boundingbox_Y.max()+2.0/3*boundingbox_Y.min();

grid_point14[Geom::X] = 1.0/3*boundingbox_X.max()+2.0/3*boundingbox_X.min();

grid_point14[Geom::Y] = 2.0/3*boundingbox_Y.max()+1.0/3*boundingbox_Y.min();

grid_point15[Geom::X] = 2.0/3*boundingbox_X.max()+1.0/3*boundingbox_X.min();

grid_point15[Geom::Y] = 2.0/3*boundingbox_Y.max()+1.0/3*boundingbox_Y.min();

}

} //namespace LivePathEffect

} /* namespace Inkscape */