/*
 * LineUnittest.cpp
 *
 *  Created on: May 27, 2010
 *      Author: crueger
 */

#include "LineUnittest.hpp"

#include "vector.hpp"
#include "Exceptions/LinearDependenceException.hpp"
#include "Exceptions/SkewException.hpp"

#include <cppunit/CompilerOutputter.h>
#include <cppunit/extensions/TestFactoryRegistry.h>
#include <cppunit/ui/text/TestRunner.h>

#include <iostream>
#include <cmath>

using namespace std;

#ifdef HAVE_TESTRUNNER
#include "UnitTestMain.hpp"
#endif /*HAVE_TESTRUNNER*/

CPPUNIT_TEST_SUITE_REGISTRATION( LineUnittest );

void LineUnittest::setUp(){
  // three lines along the axes
  la1 = new Line(zeroVec,e1);
  la2 = new Line(zeroVec,e2);
  la3 = new Line(zeroVec,e3);

  // the lines along the planes defined by two coordinate axes
  lp1 = new Line(e1,e1-e2);
  lp2 = new Line(e2,e2-e3);
  lp3 = new Line(e3,e3-e1);
}
void LineUnittest::tearDown(){
  delete la1;
  delete la2;
  delete la3;

  delete lp1;
  delete lp2;
  delete lp3;
}

void LineUnittest::constructionErrorTest(){
  // test some constructions

  // direction+origin should never fail
  CPPUNIT_ASSERT_NO_THROW(Line(zeroVec,e1));
  CPPUNIT_ASSERT_NO_THROW(Line(zeroVec,e2));
  CPPUNIT_ASSERT_NO_THROW(Line(zeroVec,e3));

  // two points fails if both points are the same
  CPPUNIT_ASSERT_NO_THROW(makeLineThrough(e1,e2));
  CPPUNIT_ASSERT_NO_THROW(makeLineThrough(e2,e3));
  CPPUNIT_ASSERT_NO_THROW(makeLineThrough(e3,e1));
  // for zerovectors
  CPPUNIT_ASSERT_NO_THROW(makeLineThrough(e1,zeroVec));
  CPPUNIT_ASSERT_NO_THROW(makeLineThrough(e2,zeroVec));
  CPPUNIT_ASSERT_NO_THROW(makeLineThrough(e3,zeroVec));
  // now we pass two times the same point
  CPPUNIT_ASSERT_THROW(makeLineThrough(zeroVec,zeroVec),LinearDependenceException);
  CPPUNIT_ASSERT_THROW(makeLineThrough(e1,e1),LinearDependenceException);
  CPPUNIT_ASSERT_THROW(makeLineThrough(e2,e2),LinearDependenceException);
  CPPUNIT_ASSERT_THROW(makeLineThrough(e3,e3),LinearDependenceException);

}

bool testDirection(const Vector &dir1,const Vector &dir2){
  return (dir1==dir2) || (dir1==-1*dir2);
}

void LineUnittest::constructionResultTest(){
  // test all directions
  CPPUNIT_ASSERT(testDirection(la1->getDirection(),e1));
  CPPUNIT_ASSERT(testDirection(la2->getDirection(),e2));
  CPPUNIT_ASSERT(testDirection(la3->getDirection(),e3));

  // test origins
  CPPUNIT_ASSERT_EQUAL(la1->getOrigin(),zeroVec);
  CPPUNIT_ASSERT_EQUAL(la2->getOrigin(),zeroVec);
  CPPUNIT_ASSERT_EQUAL(la2->getOrigin(),zeroVec);

  // test if desired points are on the lines
  CPPUNIT_ASSERT(la1->isContained(zeroVec));
  CPPUNIT_ASSERT(la2->isContained(zeroVec));
  CPPUNIT_ASSERT(la3->isContained(zeroVec));

  CPPUNIT_ASSERT(la1->isContained(e1));
  CPPUNIT_ASSERT(la2->isContained(e2));
  CPPUNIT_ASSERT(la3->isContained(e3));

  CPPUNIT_ASSERT(lp1->isContained(e1));
  CPPUNIT_ASSERT(lp2->isContained(e2));
  CPPUNIT_ASSERT(lp3->isContained(e3));

  CPPUNIT_ASSERT(lp1->isContained(e2));
  CPPUNIT_ASSERT(lp2->isContained(e3));
  CPPUNIT_ASSERT(lp3->isContained(e1));
}

void LineUnittest::isContainedTest(){
  // Zerovector on the axes lines
  CPPUNIT_ASSERT(la1->isContained(zeroVec));
  CPPUNIT_ASSERT(la2->isContained(zeroVec));
  CPPUNIT_ASSERT(la3->isContained(zeroVec));

  // multiples of the second support vector
  CPPUNIT_ASSERT(la1->isContained(e1));
  CPPUNIT_ASSERT(la2->isContained(e2));
  CPPUNIT_ASSERT(la3->isContained(e3));

  CPPUNIT_ASSERT(la1->isContained(2*e1));
  CPPUNIT_ASSERT(la2->isContained(2*e2));
  CPPUNIT_ASSERT(la3->isContained(2*e3));

  CPPUNIT_ASSERT(la1->isContained(3*e1));
  CPPUNIT_ASSERT(la2->isContained(3*e2));
  CPPUNIT_ASSERT(la3->isContained(3*e3));

  // negative multiples
  CPPUNIT_ASSERT(la1->isContained(-1*e1));
  CPPUNIT_ASSERT(la2->isContained(-1*e2));
  CPPUNIT_ASSERT(la3->isContained(-1*e3));

  CPPUNIT_ASSERT(la1->isContained(-2*e1));
  CPPUNIT_ASSERT(la2->isContained(-2*e2));
  CPPUNIT_ASSERT(la3->isContained(-2*e3));

  // points that should not be on the lines
  CPPUNIT_ASSERT(!la1->isContained(e2));
  CPPUNIT_ASSERT(!la2->isContained(e3));
  CPPUNIT_ASSERT(!la3->isContained(e1));

  CPPUNIT_ASSERT(!la1->isContained(2*e2));
  CPPUNIT_ASSERT(!la2->isContained(2*e3));
  CPPUNIT_ASSERT(!la3->isContained(2*e1));

  CPPUNIT_ASSERT(!la1->isContained(-1*e2));
  CPPUNIT_ASSERT(!la2->isContained(-1*e3));
  CPPUNIT_ASSERT(!la3->isContained(-1*e1));

  // For the plane lines
  CPPUNIT_ASSERT(lp1->isContained(e1));
  CPPUNIT_ASSERT(lp2->isContained(e2));
  CPPUNIT_ASSERT(lp3->isContained(e3));

  CPPUNIT_ASSERT(lp1->isContained(e2));
  CPPUNIT_ASSERT(lp2->isContained(e3));
  CPPUNIT_ASSERT(lp3->isContained(e1));

  CPPUNIT_ASSERT(lp1->isContained(e1+2*(e1-e2)));
  CPPUNIT_ASSERT(lp2->isContained(e2+2*(e2-e3)));
  CPPUNIT_ASSERT(lp3->isContained(e3+2*(e3-e1)));

  CPPUNIT_ASSERT(lp1->isContained(e1-2*(e1-e2)));
  CPPUNIT_ASSERT(lp2->isContained(e2-2*(e2-e3)));
  CPPUNIT_ASSERT(lp3->isContained(e3-2*(e3-e1)));
}

void LineUnittest::intersectionTest(){
  Vector fixture;

  // intersection of the axis lines
  fixture = la1->getIntersection(*la2);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = la2->getIntersection(*la3);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = la3->getIntersection(*la1);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);

  // axes and plane lines
  fixture = la1->getIntersection(*lp1);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);
  fixture = la2->getIntersection(*lp2);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = la3->getIntersection(*lp3);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);

  fixture = la1->getIntersection(*lp3);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);
  fixture = la2->getIntersection(*lp1);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = la3->getIntersection(*lp2);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);

  // two plane lines
  fixture = lp1->getIntersection(*lp2);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = lp2->getIntersection(*lp3);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);
  fixture = lp3->getIntersection(*lp1);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);

  // When we have two times the same line, we check if the point is on the line
  fixture = la1->getIntersection(*la1);
  CPPUNIT_ASSERT(la1->isContained(fixture));
  fixture = la2->getIntersection(*la2);
  CPPUNIT_ASSERT(la2->isContained(fixture));
  fixture = la3->getIntersection(*la3);
  CPPUNIT_ASSERT(la3->isContained(fixture));

  fixture = lp1->getIntersection(*lp1);
  CPPUNIT_ASSERT(lp1->isContained(fixture));
  fixture = lp2->getIntersection(*lp2);
  CPPUNIT_ASSERT(lp2->isContained(fixture));
  fixture = lp3->getIntersection(*lp3);
  CPPUNIT_ASSERT(lp3->isContained(fixture));

  // lines that are askew should produce an Error
  CPPUNIT_ASSERT_THROW(lp1->getIntersection(*la3),SkewException);
  CPPUNIT_ASSERT_THROW(lp2->getIntersection(*la1),SkewException);
  CPPUNIT_ASSERT_THROW(lp3->getIntersection(*la2),SkewException);

  CPPUNIT_ASSERT_THROW(la1->getIntersection(*lp2),SkewException);
  CPPUNIT_ASSERT_THROW(la2->getIntersection(*lp3),SkewException);
  CPPUNIT_ASSERT_THROW(la3->getIntersection(*lp1),SkewException);
}

void LineUnittest::rotationTest(){
  Vector fixture;

  // rotate zero Vector along the axes lines by various degrees
  fixture = la1->rotateVector(zeroVec,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = la2->rotateVector(zeroVec,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = la3->rotateVector(zeroVec,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);

  fixture = la1->rotateVector(zeroVec,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = la2->rotateVector(zeroVec,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = la3->rotateVector(zeroVec,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);

  // rotate vectors on the axis around their lines
  fixture = la1->rotateVector(e1,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);
  fixture = la2->rotateVector(e2,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = la3->rotateVector(e3,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);

  fixture = la1->rotateVector(e1,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);
  fixture = la2->rotateVector(e2,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = la3->rotateVector(e3,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);

  // more vectors on the axis
  fixture = la1->rotateVector(2*e1,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,2*e1);
  fixture = la2->rotateVector(2*e2,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,2*e2);
  fixture = la3->rotateVector(2*e3,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,2*e3);

  fixture = la1->rotateVector(2*e1,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,2*e1);
  fixture = la2->rotateVector(2*e2,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,2*e2);
  fixture = la3->rotateVector(2*e3,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,2*e3);

  // negative factors
  fixture = la1->rotateVector(-1*e1,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e1);
  fixture = la2->rotateVector(-1*e2,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e2);
  fixture = la3->rotateVector(-1*e3,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e3);

  fixture = la1->rotateVector(-1*e1,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e1);
  fixture = la2->rotateVector(-1*e2,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e2);
  fixture = la3->rotateVector(-1*e3,2.);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e3);



  // now the real rotations
  // e2 around e1
  fixture = la1->rotateVector(e2,0);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = la1->rotateVector(e2,1./2.*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e3);
  fixture = la1->rotateVector(e2,M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e2);
  fixture = la1->rotateVector(e2,2*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);

  // e3 around e2
  fixture = la2->rotateVector(e3,0);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);
  fixture = la2->rotateVector(e3,1./2.*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e1);
  fixture = la2->rotateVector(e3,M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e3);
  fixture = la2->rotateVector(e3,2*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);

  // e1 around e3
  fixture = la3->rotateVector(e1,0);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);
  fixture = la3->rotateVector(e1,1./2.*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e2);
  fixture = la3->rotateVector(e1,M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,-1*e1);
  fixture = la3->rotateVector(e1,2*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);


  // and some rotation around the plane lines

  // Vectors on the line
  fixture = lp1->rotateVector(e1,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);
  fixture = lp1->rotateVector(e2,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);

  fixture = lp2->rotateVector(e2,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e2);
  fixture = lp2->rotateVector(e3,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);

  fixture = lp3->rotateVector(e3,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e3);
  fixture = lp3->rotateVector(e1,1.);
  CPPUNIT_ASSERT_EQUAL(fixture,e1);

  // the real stuff
  fixture = lp1->rotateVector(zeroVec,M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,Vector(1,1,0));
  fixture = lp2->rotateVector(zeroVec,M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,Vector(0,1,1));
  fixture = lp3->rotateVector(zeroVec,M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,Vector(1,0,1));

  fixture = lp1->rotateVector(zeroVec,2*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = lp2->rotateVector(zeroVec,2*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
  fixture = lp3->rotateVector(zeroVec,2*M_PI);
  CPPUNIT_ASSERT_EQUAL(fixture,zeroVec);
}