| double Impala::Core::Array::Element::EuclidDistSquare | ( | const Vec3Real64 & | p1, | |
| const Vec3Real64 & | p2 | |||
| ) | [inline] |
Definition at line 33 of file FunctorKalman.h.
References Impala::Core::Array::Element::Vec3Real64::X(), Impala::Core::Array::Element::Vec3Real64::Y(), and Impala::Core::Array::Element::Vec3Real64::Z().
Referenced by Impala::Core::Array::Trait::FuncKalman::doIt().
00034 { 00035 double t,d; 00036 t = p1.X() - p2.X(); 00037 d = t*t; 00038 t = p1.Y() - p2.Y(); 00039 d += t*t; 00040 t = p1.Z() - p2.Z(); 00041 d += t*t; 00042 return d; 00043 }
Here is the call graph for this function:
