add general p*p

classic/5.0/src/Algorithms/PartBunch.h

@@ -518,6 +518,7 @@ private:
     double calculateAngle2(double x, double y);
 
 
+    double pSqr(Vector_t p1, Vector_t p2) const;
     void calcEMean(); // update eKin_m;
 
 
@@ -681,6 +682,12 @@ private:
 
 };
 
+inline double PartBunch::pSqr(Vector_t p1, Vector_t p2) const {
+  return p1[0]*p2[0] + p1[0]*p2[1] + p1[0]*p2[2] + p1[1]*p2[0] + p1[1]*p2[1] + p1[1]*p2[2] + p1[2]*p2[0] + p1[2]*p2[1] + p1[2]*p2[2];
+}
+
+
+
 inline 
 bool PartBunch::isDcBeam() { return dcBeam_m;}