13 #include <TMatrixFSym.h>
15 #include <analysis/VertexFitting/KFit/MakeMotherKFit.h>
16 #include <analysis/VertexFitting/KFit/MassFitKFit.h>
17 #include <analysis/utility/CLHEPToROOT.h>
22 using namespace Belle2::analysis;
23 using namespace CLHEP;
25 MassFitKFit::MassFitKFit()
28 m_FlagTrackVertexError =
false;
29 m_FlagFitIncludingVertex =
false;
30 m_FlagAtDecayPoint =
true;
31 m_NecessaryTrackCount = 2;
32 m_d = HepMatrix(1, 1, 0);
33 m_V_D = HepMatrix(1, 1, 0);
34 m_lam = HepMatrix(1, 1, 0);
35 m_AfterVertexError = HepSymMatrix(3, 0);
36 m_InvariantMass = -1.0;
40 MassFitKFit::~MassFitKFit() =
default;
47 return m_ErrorCode = KFitError::kNoError;
52 MassFitKFit::setVertexError(
const HepSymMatrix& e) {
55 m_ErrorCode = KFitError::kBadMatrixSize;
56 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
60 m_BeforeVertexError = e;
61 m_FlagFitIncludingVertex =
true;
63 return m_ErrorCode = KFitError::kNoError;
68 MassFitKFit::setInvariantMass(
const double m) {
71 return m_ErrorCode = KFitError::kNoError;
76 MassFitKFit::setFlagAtDecayPoint(
const bool flag) {
77 m_FlagAtDecayPoint = flag;
79 return m_ErrorCode = KFitError::kNoError;
84 MassFitKFit::fixMass() {
85 m_IsFixMass.push_back(
true);
87 return m_ErrorCode = KFitError::kNoError;
92 MassFitKFit::unfixMass() {
93 m_IsFixMass.push_back(
false);
95 return m_ErrorCode = KFitError::kNoError;
100 MassFitKFit::setTrackVertexError(
const HepMatrix& e) {
101 if (e.num_row() != 3 || e.num_col() != KFitConst::kNumber7)
103 m_ErrorCode = KFitError::kBadMatrixSize;
104 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
108 m_BeforeTrackVertexError.push_back(e);
109 m_FlagTrackVertexError =
true;
110 m_FlagFitIncludingVertex =
true;
112 return m_ErrorCode = KFitError::kNoError;
117 MassFitKFit::setTrackZeroVertexError() {
118 HepMatrix zero(3, KFitConst::kNumber7, 0);
120 return this->setTrackVertexError(zero);
125 MassFitKFit::setCorrelation(
const HepMatrix& m) {
126 return KFitBase::setCorrelation(m);
131 MassFitKFit::setZeroCorrelation() {
132 return KFitBase::setZeroCorrelation();
137 MassFitKFit::getVertex(
const int flag)
const
139 if (flag == KFitConst::kAfterFit && !isFitted())
return HepPoint3D();
142 case KFitConst::kBeforeFit:
143 return m_BeforeVertex;
145 case KFitConst::kAfterFit:
146 return m_AfterVertex;
149 KFitError::displayError(__FILE__, __LINE__, __func__, KFitError::kOutOfRange);
156 MassFitKFit::getVertexError(
const int flag)
const
158 if (flag == KFitConst::kAfterFit && !isFitted())
return HepSymMatrix(3, 0);
160 if (flag == KFitConst::kBeforeFit)
161 return m_BeforeVertexError;
162 else if (flag == KFitConst::kAfterFit && m_FlagFitIncludingVertex)
163 return m_AfterVertexError;
165 KFitError::displayError(__FILE__, __LINE__, __func__, KFitError::kOutOfRange);
166 return HepSymMatrix(3, 0);
172 MassFitKFit::getInvariantMass()
const
174 return m_InvariantMass;
179 MassFitKFit::getFlagAtDecayPoint()
const
181 return m_FlagAtDecayPoint;
186 MassFitKFit::getFlagFitWithVertex()
const
188 return m_FlagFitIncludingVertex;
193 MassFitKFit::getCHIsq()
const
200 MassFitKFit::getTrackVertexError(
const int id,
const int flag)
const
202 if (flag == KFitConst::kAfterFit && !isFitted())
return HepMatrix(3, KFitConst::kNumber7, 0);
203 if (!isTrackIDInRange(
id))
return HepMatrix(3, KFitConst::kNumber7, 0);
205 if (flag == KFitConst::kBeforeFit)
206 return m_BeforeTrackVertexError[id];
207 else if (flag == KFitConst::kAfterFit && m_FlagFitIncludingVertex)
208 return m_AfterTrackVertexError[id];
210 KFitError::displayError(__FILE__, __LINE__, __func__, KFitError::kOutOfRange);
211 return HepMatrix(3, KFitConst::kNumber7, 0);
217 MassFitKFit::getTrackCHIsq(
const int id)
const
219 if (!isFitted())
return -1;
220 if (!isTrackIDInRange(
id))
return -1;
222 if (m_IsFixMass[
id]) {
224 HepMatrix da(m_Tracks[
id].getFitParameter(KFitConst::kBeforeFit) - m_Tracks[
id].getFitParameter(KFitConst::kAfterFit));
226 const double chisq = (da.T() * (m_Tracks[id].getFitError(KFitConst::kBeforeFit).inverse(err_inverse)) * da)[0][0];
229 KFitError::displayError(__FILE__, __LINE__, __func__, KFitError::kCannotGetMatrixInverse);
237 HepMatrix da(m_Tracks[
id].getMomPos(KFitConst::kBeforeFit) - m_Tracks[
id].getMomPos(KFitConst::kAfterFit));
239 const double chisq = (da.T() * (m_Tracks[id].getError(KFitConst::kBeforeFit).inverse(err_inverse)) * da)[0][0];
242 KFitError::displayError(__FILE__, __LINE__, __func__, KFitError::kCannotGetMatrixInverse);
253 MassFitKFit::getCorrelation(
const int id1,
const int id2,
const int flag)
const
255 if (flag == KFitConst::kAfterFit && !isFitted())
return HepMatrix(KFitConst::kNumber7, KFitConst::kNumber7, 0);
256 if (!isTrackIDInRange(id1))
return HepMatrix(KFitConst::kNumber7, KFitConst::kNumber7, 0);
257 if (!isTrackIDInRange(id2))
return HepMatrix(KFitConst::kNumber7, KFitConst::kNumber7, 0);
260 case KFitConst::kBeforeFit:
261 return KFitBase::getCorrelation(id1, id2, flag);
263 case KFitConst::kAfterFit:
265 this->getTrackMomentum(id1),
266 this->getTrackMomentum(id2),
267 m_V_al_1.sub(KFitConst::kNumber7 * id1 + 1, KFitConst::kNumber7 * (id1 + 1), KFitConst::kNumber7 * id2 + 1,
268 KFitConst::kNumber7 * (id2 + 1)),
273 KFitError::displayError(__FILE__, __LINE__, __func__, KFitError::kOutOfRange);
274 return HepMatrix(KFitConst::kNumber7, KFitConst::kNumber7, 0);
280 MassFitKFit::doFit() {
281 return KFitBase::doFit1();
286 MassFitKFit::prepareInputMatrix() {
287 if (m_TrackCount > KFitConst::kMaxTrackCount)
289 m_ErrorCode = KFitError::kBadTrackSize;
290 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
295 if (m_IsFixMass.size() == 0)
299 for (
int i = 0; i < m_TrackCount; i++) this->fixMass();
300 }
else if (m_IsFixMass.size() != (
unsigned int)m_TrackCount)
302 m_ErrorCode = KFitError::kBadTrackSize;
303 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
308 if (!m_FlagFitIncludingVertex)
311 m_al_0 = HepMatrix(KFitConst::kNumber7 * m_TrackCount, 1, 0);
312 m_property = HepMatrix(m_TrackCount, 3, 0);
313 m_V_al_0 = HepSymMatrix(KFitConst::kNumber7 * m_TrackCount, 0);
315 for (
auto& track : m_Tracks) {
317 m_al_0[index * KFitConst::kNumber7 + 0][0] = track.getMomentum(KFitConst::kBeforeFit).x();
318 m_al_0[index * KFitConst::kNumber7 + 1][0] = track.getMomentum(KFitConst::kBeforeFit).y();
319 m_al_0[index * KFitConst::kNumber7 + 2][0] = track.getMomentum(KFitConst::kBeforeFit).z();
320 m_al_0[index * KFitConst::kNumber7 + 3][0] = track.getMomentum(KFitConst::kBeforeFit).t();
321 m_al_0[index * KFitConst::kNumber7 + 4][0] = track.getPosition(KFitConst::kBeforeFit).x();
322 m_al_0[index * KFitConst::kNumber7 + 5][0] = track.getPosition(KFitConst::kBeforeFit).y();
323 m_al_0[index * KFitConst::kNumber7 + 6][0] = track.getPosition(KFitConst::kBeforeFit).z();
325 m_V_al_0.sub(index * KFitConst::kNumber7 + 1, track.getError(KFitConst::kBeforeFit));
327 m_property[index][0] = track.getCharge();
328 m_property[index][1] = track.getMass();
329 const double c = KFitConst::kLightSpeed;
331 m_property[index][2] = -c * m_MagneticField * track.getCharge();
336 if (m_FlagCorrelation) {
337 this->prepareCorrelation();
338 if (m_ErrorCode != KFitError::kNoError) {
339 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
348 m_V_al_1 = HepMatrix(KFitConst::kNumber7 * m_TrackCount, KFitConst::kNumber7 * m_TrackCount, 0);
349 m_D = m_V_al_1.sub(1, 1, 1, KFitConst::kNumber7 * m_TrackCount);
354 m_al_0 = HepMatrix(KFitConst::kNumber7 * m_TrackCount + 3, 1, 0);
355 m_property = HepMatrix(m_TrackCount, 3, 0);
356 m_V_al_0 = HepSymMatrix(KFitConst::kNumber7 * m_TrackCount + 3, 0);
358 for (
auto& track : m_Tracks)
361 m_al_0[index * KFitConst::kNumber7 + 0][0] = track.getMomentum(KFitConst::kBeforeFit).x();
362 m_al_0[index * KFitConst::kNumber7 + 1][0] = track.getMomentum(KFitConst::kBeforeFit).y();
363 m_al_0[index * KFitConst::kNumber7 + 2][0] = track.getMomentum(KFitConst::kBeforeFit).z();
364 m_al_0[index * KFitConst::kNumber7 + 3][0] = track.getMomentum(KFitConst::kBeforeFit).t();
365 m_al_0[index * KFitConst::kNumber7 + 4][0] = track.getPosition(KFitConst::kBeforeFit).x();
366 m_al_0[index * KFitConst::kNumber7 + 5][0] = track.getPosition(KFitConst::kBeforeFit).y();
367 m_al_0[index * KFitConst::kNumber7 + 6][0] = track.getPosition(KFitConst::kBeforeFit).z();
369 m_V_al_0.sub(index * KFitConst::kNumber7 + 1, track.getError(KFitConst::kBeforeFit));
371 m_property[index][0] = track.getCharge();
372 m_property[index][1] = track.getMass();
373 const double c = KFitConst::kLightSpeed;
375 m_property[index][2] = -c * m_MagneticField * track.getCharge();
380 m_al_0[KFitConst::kNumber7 * m_TrackCount + 0][0] = m_BeforeVertex.x();
381 m_al_0[KFitConst::kNumber7 * m_TrackCount + 1][0] = m_BeforeVertex.y();
382 m_al_0[KFitConst::kNumber7 * m_TrackCount + 2][0] = m_BeforeVertex.z();
383 m_V_al_0.sub(KFitConst::kNumber7 * m_TrackCount + 1, m_BeforeVertexError);
386 if (m_FlagCorrelation)
388 this->prepareCorrelation();
389 if (m_ErrorCode != KFitError::kNoError) {
390 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
399 m_V_al_1 = HepMatrix(KFitConst::kNumber7 * m_TrackCount + 3, KFitConst::kNumber7 * m_TrackCount + 3, 0);
400 m_D = m_V_al_1.sub(1, 1, 1, KFitConst::kNumber7 * m_TrackCount + 3);
403 return m_ErrorCode = KFitError::kNoError;
408 MassFitKFit::prepareInputSubMatrix() {
410 sprintf(buf,
"%s:%s(): internal error; this function should never be called", __FILE__, __func__);
414 return KFitError::kOutOfRange;
419 MassFitKFit::prepareCorrelation() {
420 if (m_BeforeCorrelation.size() !=
static_cast<unsigned int>(m_TrackCount * (m_TrackCount - 1) / 2))
422 m_ErrorCode = KFitError::kBadCorrelationSize;
423 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
427 int row = 0, col = 0;
429 for (
auto& hm : m_BeforeCorrelation)
433 if (row == m_TrackCount) {
439 for (
int i = KFitConst::kNumber7 * row; i < KFitConst::kNumber7 * (row + 1); i++) {
440 for (
int j = KFitConst::kNumber7 * col; j < KFitConst::kNumber7 * (col + 1); j++) {
441 m_V_al_0[i][j] = hm[ii][jj];
449 if (m_FlagFitIncludingVertex)
452 m_V_al_0.sub(KFitConst::kNumber7 * m_TrackCount + 1, m_BeforeVertexError);
455 if (m_FlagTrackVertexError) {
456 if (m_BeforeTrackVertexError.size() != (
unsigned int)m_TrackCount) {
457 m_ErrorCode = KFitError::kBadCorrelationSize;
458 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
463 for (
auto& hm : m_BeforeTrackVertexError) {
464 for (
int j = 0; j < 3; j++)
for (
int k = 0; k < KFitConst::kNumber7; k++) {
465 m_V_al_0[j + KFitConst::kNumber7 * m_TrackCount][k + i * KFitConst::kNumber7] = hm[j][k];
472 return m_ErrorCode = KFitError::kNoError;
477 MassFitKFit::prepareOutputMatrix() {
480 for (
auto& pdata : m_Tracks)
484 h3v.setX(m_al_1[index * KFitConst::kNumber7 + 0][0]);
485 h3v.setY(m_al_1[index * KFitConst::kNumber7 + 1][0]);
486 h3v.setZ(m_al_1[index * KFitConst::kNumber7 + 2][0]);
487 if (m_IsFixMass[index])
488 pdata.setMomentum(HepLorentzVector(h3v, sqrt(h3v.mag2() + pdata.getMass()*pdata.getMass())), KFitConst::kAfterFit);
490 pdata.setMomentum(HepLorentzVector(h3v, m_al_1[index * KFitConst::kNumber7 + 3][0]), KFitConst::kAfterFit);
493 m_al_1[index * KFitConst::kNumber7 + 4][0],
494 m_al_1[index * KFitConst::kNumber7 + 5][0],
495 m_al_1[index * KFitConst::kNumber7 + 6][0]), KFitConst::kAfterFit);
497 pdata.setError(this->makeError3(pdata.getMomentum(),
499 index * KFitConst::kNumber7 + 1,
500 (index + 1)*KFitConst::kNumber7,
501 index * KFitConst::kNumber7 + 1,
502 (index + 1)*KFitConst::kNumber7), m_IsFixMass[index]),
503 KFitConst::kAfterFit);
504 if (m_ErrorCode != KFitError::kNoError)
break;
508 if (m_FlagFitIncludingVertex)
511 m_AfterVertex.setX(m_al_1[KFitConst::kNumber7 * m_TrackCount + 0][0]);
512 m_AfterVertex.setY(m_al_1[KFitConst::kNumber7 * m_TrackCount + 1][0]);
513 m_AfterVertex.setZ(m_al_1[KFitConst::kNumber7 * m_TrackCount + 2][0]);
515 for (
int i = 0; i < 3; i++)
for (
int j = i; j < 3; j++) {
516 m_AfterVertexError[i][j] = m_V_al_1[KFitConst::kNumber7 * m_TrackCount + i][KFitConst::kNumber7 * m_TrackCount + j];
519 for (
int i = 0; i < m_TrackCount; i++) {
520 HepMatrix hm(3, KFitConst::kNumber7, 0);
521 for (
int j = 0; j < 3; j++)
for (
int k = 0; k < KFitConst::kNumber7; k++) {
522 hm[j][k] = m_V_al_1[KFitConst::kNumber7 * m_TrackCount + j][KFitConst::kNumber7 * i + k];
525 m_AfterTrackVertexError.push_back(this->makeError4(m_Tracks[i].getMomentum(), hm));
527 m_AfterTrackVertexError.push_back(hm);
531 m_AfterVertex = m_BeforeVertex;
534 return m_ErrorCode = KFitError::kNoError;
539 MassFitKFit::makeCoreMatrix() {
540 if (!m_FlagFitIncludingVertex)
543 HepMatrix al_1_prime(m_al_1);
544 HepMatrix Sum_al_1(4, 1, 0);
545 double energy[KFitConst::kMaxTrackCount2];
548 for (
int i = 0; i < m_TrackCount; i++) {
549 a = m_property[i][2];
550 if (!m_FlagAtDecayPoint) a = 0.;
551 al_1_prime[i * KFitConst::kNumber7 + 0][0] -= a * (m_BeforeVertex.y() - al_1_prime[i * KFitConst::kNumber7 + 5][0]);
552 al_1_prime[i * KFitConst::kNumber7 + 1][0] += a * (m_BeforeVertex.x() - al_1_prime[i * KFitConst::kNumber7 + 4][0]);
553 energy[i] = sqrt(al_1_prime[i * KFitConst::kNumber7 + 0][0] * al_1_prime[i * KFitConst::kNumber7 + 0][0] +
554 al_1_prime[i * KFitConst::kNumber7 + 1][0] * al_1_prime[i * KFitConst::kNumber7 + 1][0] +
555 al_1_prime[i * KFitConst::kNumber7 + 2][0] * al_1_prime[i * KFitConst::kNumber7 + 2][0] +
556 m_property[i][1] * m_property[i][1]);
559 for (
int i = 0; i < m_TrackCount; i++) {
561 Sum_al_1[3][0] += energy[i];
563 Sum_al_1[3][0] += al_1_prime[i * KFitConst::kNumber7 + 3][0];
565 for (
int j = 0; j < 3; j++) Sum_al_1[j][0] += al_1_prime[i * KFitConst::kNumber7 + j][0];
569 + Sum_al_1[3][0] * Sum_al_1[3][0] - Sum_al_1[0][0] * Sum_al_1[0][0]
570 - Sum_al_1[1][0] * Sum_al_1[1][0] - Sum_al_1[2][0] * Sum_al_1[2][0]
571 - m_InvariantMass * m_InvariantMass;
573 for (
int i = 0; i < m_TrackCount; i++) {
574 if (energy[i] == 0) {
575 m_ErrorCode = KFitError::kDivisionByZero;
576 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
580 a = m_property[i][2];
581 if (!m_FlagAtDecayPoint) a = 0.;
583 if (m_IsFixMass[i]) {
584 double invE = 1. / energy[i];
585 m_D[0][i * KFitConst::kNumber7 + 0] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 0][0] * invE - Sum_al_1[0][0]);
586 m_D[0][i * KFitConst::kNumber7 + 1] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 1][0] * invE - Sum_al_1[1][0]);
587 m_D[0][i * KFitConst::kNumber7 + 2] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 2][0] * invE - Sum_al_1[2][0]);
588 m_D[0][i * KFitConst::kNumber7 + 3] = 0.;
589 m_D[0][i * KFitConst::kNumber7 + 4] = -2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 1][0] * invE - Sum_al_1[1][0]) * a;
590 m_D[0][i * KFitConst::kNumber7 + 5] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 0][0] * invE - Sum_al_1[0][0]) * a;
591 m_D[0][i * KFitConst::kNumber7 + 6] = 0.;
593 m_D[0][i * KFitConst::kNumber7 + 0] = -2.*Sum_al_1[0][0];
594 m_D[0][i * KFitConst::kNumber7 + 1] = -2.*Sum_al_1[1][0];
595 m_D[0][i * KFitConst::kNumber7 + 2] = -2.*Sum_al_1[2][0];
596 m_D[0][i * KFitConst::kNumber7 + 3] = 2.*Sum_al_1[3][0];
597 m_D[0][i * KFitConst::kNumber7 + 4] = 2.*Sum_al_1[1][0] * a;
598 m_D[0][i * KFitConst::kNumber7 + 5] = -2.*Sum_al_1[0][0] * a;
599 m_D[0][i * KFitConst::kNumber7 + 6] = 0.;
606 HepMatrix al_1_prime(m_al_1);
607 HepMatrix Sum_al_1(7, 1, 0);
608 double energy[KFitConst::kMaxTrackCount2];
611 for (
int i = 0; i < m_TrackCount; i++)
613 a = m_property[i][2];
614 al_1_prime[i * KFitConst::kNumber7 + 0][0] -= a * (al_1_prime[KFitConst::kNumber7 * m_TrackCount + 1][0] - al_1_prime[i *
615 KFitConst::kNumber7 + 5][0]);
616 al_1_prime[i * KFitConst::kNumber7 + 1][0] += a * (al_1_prime[KFitConst::kNumber7 * m_TrackCount + 0][0] - al_1_prime[i *
617 KFitConst::kNumber7 + 4][0]);
618 energy[i] = sqrt(al_1_prime[i * KFitConst::kNumber7 + 0][0] * al_1_prime[i * KFitConst::kNumber7 + 0][0] +
619 al_1_prime[i * KFitConst::kNumber7 + 1][0] * al_1_prime[i * KFitConst::kNumber7 + 1][0] +
620 al_1_prime[i * KFitConst::kNumber7 + 2][0] * al_1_prime[i * KFitConst::kNumber7 + 2][0] +
621 m_property[i][1] * m_property[i][1]);
622 Sum_al_1[6][0] = + a;
625 for (
int i = 0; i < m_TrackCount; i++)
627 if (energy[i] == 0) {
628 m_ErrorCode = KFitError::kDivisionByZero;
629 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
633 if (m_IsFixMass[i]) {
634 double invE = 1. / energy[i];
635 Sum_al_1[3][0] += energy[i];
636 Sum_al_1[4][0] += al_1_prime[i * KFitConst::kNumber7 + 1][0] * m_property[i][2] * invE;
637 Sum_al_1[5][0] += al_1_prime[i * KFitConst::kNumber7 + 0][0] * m_property[i][2] * invE;
639 Sum_al_1[3][0] += al_1_prime[i * KFitConst::kNumber7 + 3][0];
642 for (
int j = 0; j < 3; j++) Sum_al_1[j][0] += al_1_prime[i * KFitConst::kNumber7 + j][0];
646 + Sum_al_1[3][0] * Sum_al_1[3][0] - Sum_al_1[0][0] * Sum_al_1[0][0]
647 - Sum_al_1[1][0] * Sum_al_1[1][0] - Sum_al_1[2][0] * Sum_al_1[2][0]
648 - m_InvariantMass * m_InvariantMass;
650 for (
int i = 0; i < m_TrackCount; i++)
652 if (energy[i] == 0) {
653 m_ErrorCode = KFitError::kDivisionByZero;
654 KFitError::displayError(__FILE__, __LINE__, __func__, m_ErrorCode);
658 a = m_property[i][2];
660 if (m_IsFixMass[i]) {
661 double invE = 1. / energy[i];
662 m_D[0][i * KFitConst::kNumber7 + 0] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 0][0] * invE - Sum_al_1[0][0]);
663 m_D[0][i * KFitConst::kNumber7 + 1] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 1][0] * invE - Sum_al_1[1][0]);
664 m_D[0][i * KFitConst::kNumber7 + 2] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 2][0] * invE - Sum_al_1[2][0]);
665 m_D[0][i * KFitConst::kNumber7 + 3] = 0.;
666 m_D[0][i * KFitConst::kNumber7 + 4] = -2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 1][0] * invE - Sum_al_1[1][0]) * a;
667 m_D[0][i * KFitConst::kNumber7 + 5] = 2.*(Sum_al_1[3][0] * al_1_prime[i * KFitConst::kNumber7 + 0][0] * invE - Sum_al_1[0][0]) * a;
668 m_D[0][i * KFitConst::kNumber7 + 6] = 0.;
670 m_D[0][i * KFitConst::kNumber7 + 0] = -2.*Sum_al_1[0][0];
671 m_D[0][i * KFitConst::kNumber7 + 1] = -2.*Sum_al_1[1][0];
672 m_D[0][i * KFitConst::kNumber7 + 2] = -2.*Sum_al_1[2][0];
673 m_D[0][i * KFitConst::kNumber7 + 3] = 2.*Sum_al_1[3][0];
674 m_D[0][i * KFitConst::kNumber7 + 4] = 2.*Sum_al_1[1][0] * a;
675 m_D[0][i * KFitConst::kNumber7 + 5] = -2.*Sum_al_1[0][0] * a;
676 m_D[0][i * KFitConst::kNumber7 + 6] = 0.;
680 m_D[0][KFitConst::kNumber7 * m_TrackCount + 0] = 2.*(Sum_al_1[3][0] * Sum_al_1[4][0] - Sum_al_1[1][0] * Sum_al_1[6][0]);
681 m_D[0][KFitConst::kNumber7 * m_TrackCount + 1] = -2.*(Sum_al_1[3][0] * Sum_al_1[5][0] - Sum_al_1[0][0] * Sum_al_1[6][0]);
682 m_D[0][KFitConst::kNumber7 * m_TrackCount + 2] = 0.;
685 return m_ErrorCode = KFitError::kNoError;
690 MassFitKFit::calculateNDF() {
693 return m_ErrorCode = KFitError::kNoError;
700 unsigned n = getTrackCount();
701 for (
unsigned i = 0; i < n; ++i) {
702 kmm.
addTrack(getTrackMomentum(i), getTrackPosition(i), getTrackError(i),
703 getTrack(i).getCharge());
704 if (getFlagFitWithVertex())
706 for (
unsigned j = i + 1; j < n; ++j) {
711 if (getFlagFitWithVertex())
713 m_ErrorCode = kmm.
doMake();
714 if (m_ErrorCode != KFitError::kNoError)
716 double chi2 = getCHIsq();
718 double prob = TMath::Prob(chi2, ndf);
720 bool haschi2 = mother->hasExtraInfo(
"chiSquared");
722 mother->setExtraInfo(
"chiSquared", chi2);
723 mother->setExtraInfo(
"ndf", ndf);
725 mother->addExtraInfo(
"chiSquared", chi2);
726 mother->addExtraInfo(
"ndf", ndf);
729 mother->updateMomentum(
734 m_ErrorCode = KFitError::kNoError;