// $Id$
//
//    File: DFDCPseudo_factory_WIRESONLY.cc
// Created: Fri Nov  9 09:57:12 EST 2007
// Creator: davidl (on Darwin fwing-dhcp95.jlab.org 8.10.1 i386)
//

#include "DVector2.h"
#include "FDC/DFDCIntersection.h"

#include "DFDCPseudo_factory_WIRESONLY.h"

//------------------
// evnt
//------------------
jerror_t DFDCPseudo_factory_WIRESONLY::evnt(JEventLoop *loop, int eventnumber)
{
	vector<const DFDCIntersection*> fdcintersections;
	loop->Get(fdcintersections);

	for(unsigned int i=0; i<fdcintersections.size(); i++){
		const DFDCIntersection *fdcintersection = fdcintersections[i];
		
		// Here we add 2 pseudo points for each intersection point
		MakePseudo(fdcintersection->hit1, fdcintersection->wire1, fdcintersection->pos);
		MakePseudo(fdcintersection->hit2, fdcintersection->wire2, fdcintersection->pos);
		
	}

	return NOERROR;
}

//------------------
// MakePseudo
//------------------
void DFDCPseudo_factory_WIRESONLY::MakePseudo(const DFDCHit *hit, const DFDCWire *wire, const DVector3 &pos)
{
	DFDCPseudo *pseudo = new DFDCPseudo;
	
	DVector2 R(pos.X(), pos.Y());
	DVector2 udir(wire->udir.X(), wire->udir.Y());
	DVector2 a(wire->origin.X(), wire->origin.Y());
	
	pseudo->w = R*a;
	pseudo->dw = 1.0/sqrt(12.0); // cm
	pseudo->s = (R-a)*udir;
	pseudo->ds = 1.0/sqrt(12.0); // cm
	pseudo->wire = wire;
	pseudo->time = hit->t;
	pseudo->dist = pseudo->time*55.0E-4; // cm
	pseudo->status = 1;  // 1 external hit used to find intersection
	pseudo->x = pos.X();
	pseudo->y = pos.Y();
	
	// Intialize covariance matrix in w/s coordinate system
	DMatrix cov(2,2);
	cov(0,0) = pseudo->dw*pseudo->dw;	cov(1,0) = 0.0;
	cov(0,1) = 0.0;							cov(1,1) = pseudo->ds*pseudo->ds;
	
	// Build rotation matrix for rotating into x/y coordinate system
	DMatrix Rot(2,2);
	double cos_angle = cos(wire->angle);
	double sin_angle = sin(wire->angle);
	Rot(0,0) = cos_angle;		Rot(1,0) = sin_angle;
	Rot(0,1) = -sin_angle;		Rot(1,1) = cos_angle;
	DMatrix RotT(DMatrix::kTransposed, Rot);
	
	// Apply rotation to covariance matrix
	pseudo->cov.ResizeTo(cov);
	pseudo->cov = RotT*cov*Rot; // (I think this is right??)

	_data.push_back(pseudo);
}

//------------------
// toString
//------------------
const string DFDCPseudo_factory_WIRESONLY::toString(void)
{
	// Ensure our Get method has been called so _data is up to date
	Get();
	if(_data.size()<=0)return string(); // don't print anything if we have no data!

	printheader("layer: wire: time(ns):      w(cm):     s(cm):   status:");

	for(unsigned int i=0; i<_data.size(); i++){
		DFDCPseudo *hit = _data[i];
		//const DFDCWire *w = hit->wire;

		printnewrow();
		printcol("%d",		hit->wire->layer);
		printcol("%d",		hit->wire->wire);
		printcol("%3.1f",	hit->time);
		printcol("%3.1f",	hit->w);
		printcol("%1.4f",	hit->s);
		printcol("%d",		hit->status);
		printrow();
	}

	return _table;
}