-float File::CalculLikelyhood2Vec(vector3D refA, vector3D refB,
- vector3D ori1, vector3D ori2)
+inline double square_dist(vector3D const &v1, vector3D const & v2)
+{
+ double res;
+ res = (v1.x - v2.x)*(v1.x - v2.x) +
+ (v1.y - v2.y)*(v1.y - v2.y) +
+ (v1.z - v2.z)*(v1.z - v2.z);
+ return res;
+}
+
+float File::CalculLikelyhood2Vec(vector3D const & refA, vector3D const &refB,
+ vector3D const & ori1, vector3D const &ori2)