/* src/graphics-info-lsq.cc
 *
 * Copyright 2004 by The University of York
 * Author: Paul Emsley
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as published
 * by the Free Software Foundation; either version 3 of the License, 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
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License and
 * the GNU Lesser 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.
 */


#ifdef USE_PYTHON
#include "Python.h"  // before system includes to stop "POSIX_C_SOURCE" redefined problems
#endif

#include "compat/coot-sysdep.h"

#ifndef HAVE_STRING
#define HAVE_STRING
#include <string>
#endif

#ifndef HAVE_VECTOR
#define HAVE_VECTOR
#include <vector>
#endif

#include <gtk/gtk.h>  // must come after mmdb_manager on MacOS X Darwin
 // #include <GL/glut.h>  // for some reason...  // Eh?

#include "clipper/core/rotation.h"

#include <iostream>

#include <mmdb2/mmdb_manager.h>
#include "coords/mmdb-extras.h"
#include "coords/mmdb.hh"
#include "coords/mmdb-crystal.h"

#include "graphics-info.h"
#include "interface.h"

#include "molecule-class-info.h"

#include "utils/coot-utils.hh"



// --------- LSQing ---------------
std::pair<int, clipper::RTop_orth>
graphics_info_t::apply_lsq(int imol_ref, int imol_moving,
			   const std::vector<coot::lsq_range_match_info_t> &matches) {

   return lsq_get_and_apply_matrix_maybe(imol_ref, imol_moving, matches, 1);
}

// sometimes we just want the matrix but not to actually move the coordinates.
std::pair<int, clipper::RTop_orth>
graphics_info_t::lsq_get_and_apply_matrix_maybe(int imol_ref, int imol_moving,
						const std::vector<coot::lsq_range_match_info_t> &matches,
						bool apply_matrix) {

   int status = 0;
   clipper::Mat33<double> m_dum(1,0,0,0,1,0,0,0,1);
   clipper::Coord_orth pt_dum(0,0,0);
   clipper::RTop_orth rtop_r(m_dum, pt_dum);
   if (imol_ref < n_molecules()) {
      if (molecules[imol_ref].has_model()) {
	 if (imol_moving < n_molecules()) {
	    if (molecules[imol_moving].has_model()) {

	       mmdb::Manager *mol_ref = molecules[imol_ref].atom_sel.mol;
	       mmdb::Manager *mol_mov = molecules[imol_moving].atom_sel.mol;
	       std::pair<short int, clipper::RTop_orth> rtop_info =
		  coot::util::get_lsq_matrix(mol_ref, mol_mov,
					     matches, 1);
	       if (rtop_info.first) {

		  // A blob of code from Kevin for the axis orienation:
		  clipper::Mat33<> mat = rtop_info.second.rot();
		  clipper::Vec3<> v0( mat(0,0) - 1.0, mat(1,0), mat(2,0) );
		  clipper::Vec3<> v1( mat(0,1), mat(1,1) - 1.0, mat(2,1) );
		  clipper::Vec3<> v2( mat(0,2), mat(1,2), mat(2,2) - 1.0 );
		  clipper::Vec3<> v3 = clipper::Vec3<>::cross( v1, v2 );
		  clipper::Vec3<> v4 = clipper::Vec3<>::cross( v0, v2 );
		  clipper::Vec3<> v5 = clipper::Vec3<>::cross( v0, v1 );
		  if ( v3*v3 > v4*v4 && v3*v3 > v5*v5 )
		     v0 = v3.unit();
		  else if ( v4*v4 > v5*v5 )
		     v0 = v4.unit();
		  else
		     v0 = v5.unit();

		  std::cout << "INFO:: Axis orientation: " << v0.format() << std::endl;
		  std::cout << "INFO:: Rotation in CCP4 Polar Angles: "
			    << clipper::Rotation(rtop_info.second.rot()).polar_ccp4().format()
			    << std::endl;


		  if (apply_matrix) {
		     molecules[imol_moving].transform_by(rtop_info.second);
		     coot::util::copy_cell_and_symm_headers(mol_ref, mol_mov);
		  }

		  rtop_r = rtop_info.second;
		  graphics_draw();
		  status = 1; // done good (used to dismiss/destroy the widget)
	       }
	    }
	 }
      }
   }

   return std::pair<int, clipper::RTop_orth> (status, rtop_r);
}
