| double Impala::Core::Array::Element::EuclidDistSquare | ( | const Vec3Real64 & | p1, | |
| const Vec3Real64 & | p2 | |||
| ) | [inline] |
Definition at line 15 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().
00016 { 00017 double t,d; 00018 t = p1.X() - p2.X(); 00019 d = t*t; 00020 t = p1.Y() - p2.Y(); 00021 d += t*t; 00022 t = p1.Z() - p2.Z(); 00023 d += t*t; 00024 return d; 00025 }
Here is the call graph for this function:
