00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018 using namespace std;
00019
00020 #include <iostream>
00021 #include "FWCore/MessageLogger/interface/MessageLogger.h"
00022 #include "PhysicsTools/KinFitter/interface/TFitParticleSpher.h"
00023 #include "TMath.h"
00024
00025 ClassImp(TFitParticleSpher)
00026
00027
00028
00029
00030 TFitParticleSpher::TFitParticleSpher()
00031 :TAbsFitParticle()
00032 {
00033 init(0, 0);
00034 }
00035
00036 TFitParticleSpher::TFitParticleSpher( const TFitParticleSpher& fitParticle )
00037 :TAbsFitParticle( fitParticle.GetName(), fitParticle.GetTitle() )
00038 {
00039
00040 _nPar = fitParticle._nPar;
00041 _u1 = fitParticle._u1;
00042 _u2 = fitParticle._u2;
00043 _u3 = fitParticle._u3;
00044 _covMatrix.ResizeTo( fitParticle._covMatrix );
00045 _covMatrix = fitParticle._covMatrix;
00046 _iniparameters.ResizeTo( fitParticle._iniparameters );
00047 _iniparameters = fitParticle._iniparameters;
00048 _parameters.ResizeTo( fitParticle._parameters );
00049 _parameters = fitParticle._parameters;
00050 _pini = fitParticle._pini;
00051 _pcurr = fitParticle._pcurr;
00052
00053 }
00054
00055 TFitParticleSpher::TFitParticleSpher(TLorentzVector* pini, const TMatrixD* theCovMatrix)
00056 :TAbsFitParticle()
00057 {
00058 init(pini, theCovMatrix);
00059 }
00060
00061 TFitParticleSpher::TFitParticleSpher(const TString &name, const TString &title,
00062 TLorentzVector* pini, const TMatrixD* theCovMatrix)
00063 :TAbsFitParticle(name, title)
00064 {
00065 init(pini, theCovMatrix);
00066 }
00067
00068 TAbsFitParticle* TFitParticleSpher::clone( TString newname ) const {
00069
00070
00071 TAbsFitParticle* myclone = new TFitParticleSpher( *this );
00072 if ( newname.Length() > 0 ) myclone->SetName(newname);
00073 return myclone;
00074
00075 }
00076
00077
00078
00079
00080 TFitParticleSpher::~TFitParticleSpher() {
00081
00082 }
00083
00084
00085
00086
00087 void TFitParticleSpher::init(TLorentzVector* pini, const TMatrixD* theCovMatrix ) {
00088
00089 _nPar = 4;
00090 setIni4Vec(pini);
00091 setCovMatrix(theCovMatrix);
00092
00093 }
00094
00095 TLorentzVector* TFitParticleSpher::calc4Vec( const TMatrixD* params ) {
00096
00097
00098
00099 if (params == 0) {
00100 return 0;
00101 }
00102
00103 if ( params->GetNcols() != 1 || params->GetNrows() !=_nPar ) {
00104 edm::LogError ("WrongMatrixSize")
00105 << GetName() << "::calc4Vec - Parameter matrix has wrong size.";
00106 return 0;
00107 }
00108
00109 Double_t r = (*params)(0,0);
00110 Double_t theta = (*params)(1,0);
00111 Double_t phi = (*params)(2,0);
00112 Double_t d = (*params)(3,0);
00113
00114 Double_t X = r*TMath::Cos(phi)*TMath::Sin(theta);
00115 Double_t Y = r*TMath::Sin(phi)*TMath::Sin(theta);
00116 Double_t Z = r*TMath::Cos(theta);
00117 Double_t E = TMath::Sqrt( X*X + Y*Y + Z*Z + d*d*_pini.M2() );
00118
00119 TLorentzVector* vec = new TLorentzVector( X, Y, Z, E );
00120 return vec;
00121
00122 }
00123
00124 void TFitParticleSpher::setIni4Vec(const TLorentzVector* pini) {
00125
00126
00127
00128 if (pini == 0) {
00129
00130 _u1.SetXYZ(0., 0., 0.);
00131 _u3.SetXYZ(0., 0., 0.);
00132 _u2.SetXYZ(0., 0., 0.);
00133 _pini.SetXYZT(0., 0., 0., 0.);
00134 _pcurr = _pini;
00135
00136 _iniparameters.ResizeTo(_nPar,1);
00137 _iniparameters(0,0) = 0.;
00138 _iniparameters(1,0) = 0.;
00139 _iniparameters(2,0) = 0.;
00140 _iniparameters(3,0) = 1.;
00141
00142 _parameters.ResizeTo(_nPar,1);
00143 _parameters(0,0) = 0.;
00144 _parameters(1,0) = 0.;
00145 _parameters(2,0) = 0.;
00146 _parameters(3,0) = 1.;
00147
00148 } else {
00149
00150 Double_t r = pini->P();
00151 Double_t theta = pini->Theta();
00152 Double_t phi = pini->Phi();
00153
00154 _pini = (*pini);
00155 _pcurr = _pini;
00156
00157 _iniparameters.ResizeTo(_nPar,1);
00158 _iniparameters(0,0) = r;
00159 _iniparameters(1,0) = theta;
00160 _iniparameters(2,0) = phi;
00161 _iniparameters(3,0) = 1.;
00162
00163 _parameters.ResizeTo(_nPar,1);
00164 _parameters = _iniparameters;
00165
00166 _u1.SetXYZ( TMath::Cos(phi)*TMath::Sin(theta), TMath::Sin(phi)*TMath::Sin(theta), TMath::Cos(theta) );
00167 _u2.SetXYZ( TMath::Cos(phi)*TMath::Cos(theta), TMath::Sin(phi)*TMath::Cos(theta), -1.*TMath::Sin(theta) );
00168 _u3.SetXYZ( -1.*TMath::Sin(phi), TMath::Cos(phi), 0. );
00169
00170 }
00171
00172 }
00173
00174 TMatrixD* TFitParticleSpher::getDerivative() {
00175
00176
00177
00178
00179 TMatrixD* DerivativeMatrix = new TMatrixD(4,4);
00180 (*DerivativeMatrix) *= 0.;
00181
00182 Double_t r = _parameters(0,0);
00183 Double_t theta = _parameters(1,0);
00184 Double_t phi = _parameters(2,0);
00185 Double_t d = _parameters(3,0);
00186
00187
00188 (*DerivativeMatrix)(0,0) = TMath::Cos(phi)*TMath::Sin(theta);
00189 (*DerivativeMatrix)(1,0) = TMath::Sin(phi)*TMath::Sin(theta);
00190 (*DerivativeMatrix)(2,0) = TMath::Cos(theta);
00191 (*DerivativeMatrix)(3,0) = 0.;
00192
00193
00194 (*DerivativeMatrix)(0,1) = r*TMath::Cos(phi)*TMath::Cos(theta);
00195 (*DerivativeMatrix)(1,1) = r*TMath::Sin(phi)*TMath::Cos(theta);
00196 (*DerivativeMatrix)(2,1) = -1.*r*TMath::Sin(theta);
00197 (*DerivativeMatrix)(3,1) = 0.;
00198
00199
00200 (*DerivativeMatrix)(0,2) = -1.*r*TMath::Sin(phi)*TMath::Sin(theta);
00201 (*DerivativeMatrix)(1,2) = r*TMath::Cos(phi)*TMath::Sin(theta);;
00202 (*DerivativeMatrix)(2,2) = 0.;
00203 (*DerivativeMatrix)(3,2) = 0.;
00204
00205
00206 (*DerivativeMatrix)(0,3) = 0.;
00207 (*DerivativeMatrix)(1,3) = 0.;
00208 (*DerivativeMatrix)(2,3) = 0.;
00209 (*DerivativeMatrix)(3,3) = _pini.M()*_pini.M()*d/_pcurr.E();
00210
00211 return DerivativeMatrix;
00212
00213 }
00214
00215 TMatrixD* TFitParticleSpher::transform(const TLorentzVector& vec) {
00216
00217
00218
00219
00220 TMatrixD* tparams = new TMatrixD( _nPar, 1 );
00221 (*tparams)(0,0) = vec.P();
00222 (*tparams)(1,0) = vec.Theta();
00223 (*tparams)(2,0) = vec.Phi();
00224 (*tparams)(3,0) = vec.M()/_pini.M();
00225
00226 return tparams;
00227
00228 }