import unittest
import IMP
import IMP.test
import IMP.algebra
import IMP.core
import IMP.container

class DistanceTests(IMP.test.TestCase):
    """Test the symmetry restraint"""
    def test_symmetry(self):
        """Test the transform pair score basics"""
        IMP.set_log_level(IMP.VERBOSE)
        m= IMP.Model()
        p0= IMP.Particle(m)
        d0= IMP.core.XYZ.setup_particle(p0)
        p1= IMP.Particle(m)
        d1= IMP.core.XYZ.setup_particle(p1)
        t=IMP.algebra.Vector3D(0,1,0)
        tr= IMP.algebra.Transformation3D(IMP.algebra.get_identity_rotation_3d(), t)
        tps= IMP.core.TransformedDistancePairScore(IMP.core.Harmonic(0,1), tr)
        tps.set_was_used(True)
        d0.set_coordinates(IMP.algebra.Vector3D(2,3,4))
        d1.set_coordinates(IMP.algebra.Vector3D(2,2,4))
        self.assertEqual(tps.evaluate(IMP.ParticlePair(p0, p1), None), 0)
        self.assert_(tps.evaluate(IMP.ParticlePair(p1, p0), None) != 0)

        print "test rotation"
        rot= IMP.algebra.get_rotation_from_matrix(0, 0,-1,
                                              0, 1, 0,
                                              1, 0, 0)
        tr= IMP.algebra.Transformation3D(rot, t)
        tps.set_transformation(tr)
        d1.set_coordinates(IMP.algebra.Vector3D(4, 2, -2))
        self.assertInTolerance(tps.evaluate(IMP.ParticlePair(p0, p1), None), 0, .01)
        self.assert_(tps.evaluate(IMP.ParticlePair(p1, p0), None) != 0)
        t=IMP.algebra.Vector3D(0,0,0)
        rot= IMP.algebra.get_rotation_from_matrix(0,-1, 0,
                                                  1, 0, 0,
                                                  0, 0, 1)
        tps.set_transformation(IMP.algebra.Transformation3D(rot, t))
        d0.set_coordinates(IMP.algebra.Vector3D(0,1,0))
        d1.set_coordinates(IMP.algebra.Vector3D(1,1,0))
        # clear derivs
        print "test derivs"
        m.evaluate(True)
        tps.evaluate(IMP.ParticlePair(p0, p1), IMP.DerivativeAccumulator(1))
        print d0.get_derivative(0)
        print d0.get_derivative(1)
        print d0.get_derivative(2)
        print d1.get_derivative(0)
        print d1.get_derivative(1)
        print d1.get_derivative(2)
        self.assert_(d0.get_derivative(0) > 0)
        self.assertInTolerance(d0.get_derivative(1), 0, .1)
        self.assertInTolerance(d0.get_derivative(2), 0, .1)
        self.assert_(d1.get_derivative(1) > 0)
        self.assertInTolerance(d1.get_derivative(0), 0, .1)
        self.assertInTolerance(d1.get_derivative(2), 0, .1)
    def test_symmetry2(self):
        """Test the transform pair score optimization"""
        IMP.set_log_level(IMP.VERBOSE)
        m= IMP.Model()
        p0= IMP.Particle(m)
        d0= IMP.core.XYZ.setup_particle(p0)
        p1= IMP.Particle(m)
        d1= IMP.core.XYZ.setup_particle(p1)
        d0.set_coordinates(IMP.algebra.Vector3D(2,3,4))
        d1.set_coordinates(IMP.algebra.Vector3D(20,20,40))
        d0.set_coordinates_are_optimized(True)
        d1.set_coordinates_are_optimized(True)
        r= IMP.algebra.get_rotation_from_matrix(1, 0, 0,
                                                0, 0,-1,
                                                0, 1, 0)
        t= IMP.algebra.Vector3D(0,1,0)
        tps= IMP.core.TransformedDistancePairScore(IMP.core.Harmonic(0,1),
                                           IMP.algebra.Transformation3D(r,t))
        pl= IMP.container.ListPairContainer()
        pr= IMP.container.PairsRestraint(tps, pl)
        pl.add_particle_pair(IMP.ParticlePair(p0, p1))
        m.add_restraint(pr)
        cg= IMP.core.ConjugateGradients()
        cg.set_model(m)
        cg.optimize(100)
        d0.show()
        d1.show()
        vt= IMP.algebra.Vector3D(d1.get_coordinates()
                                     * IMP.algebra.Vector3D(1,0,0)+0,
                                 d1.get_coordinates()
                                     * IMP.algebra.Vector3D(0,0,-1)+1,
                                 d1.get_coordinates()
                                     * IMP.algebra.Vector3D(0,1,0)+0)
        print "trans"
        print str(vt[0]) + " " + str(vt[1])+" " + str(vt[2])
        self.assertInTolerance(vt[0], d0.get_coordinate(0), .1)
        self.assertInTolerance(vt[1], d0.get_coordinate(1), .1)
        self.assertInTolerance(vt[2], d0.get_coordinate(2), .1)

if __name__ == '__main__':
    unittest.main()