25 const CKFToPXDState::stateCache& fromStateCache = fromState.
getStateCache();
26 const CKFToPXDState::stateCache& toStateCache = toState.
getStateCache();
28 B2ASSERT(
"You have filled the wrong states into this!", toStateCache.isHitState);
30 if (not fromStateCache.isHitState) {
33 float phiDiff = fromStateCache.phi - toStateCache.sensorCenterPhi;
34 while (phiDiff > M_PI) phiDiff -= 2. * M_PI;
35 while (phiDiff < -M_PI) phiDiff += 2. * M_PI;
47 if (fromStateCache.geoLayer == toStateCache.geoLayer and
55 float phiDiff = fromStateCache.sensorCenterPhi - toStateCache.sensorCenterPhi;
56 while (phiDiff > M_PI) phiDiff -= 2. * M_PI;
57 while (phiDiff < -M_PI) phiDiff += 2. * M_PI;