X-Git-Url: http://47.100.26.94:8080/?a=blobdiff_plain;f=src%2Fhungarian.cpp;fp=src%2Fhungarian.cpp;h=7c1d8dad45447bd0c89d7e4a40810f3b90960f7c;hb=48adce31a0ffdb3757ee1be8a63ce7e769e87deb;hp=85b49e508bdcede372009cf2a3a566902242fb35;hpb=e45efc2cf76f6dc89e8b02484bf69a400cb93cf9;p=trackerpp.git

diff --git a/src/hungarian.cpp b/src/hungarian.cpp
index 85b49e5..7c1d8da 100644
--- a/src/hungarian.cpp
+++ b/src/hungarian.cpp
@@ -301,3 +301,15 @@ int step_six(Hungary& state)
         }
     return 4;
 }
+
+////////////////////////////////////////////////////////////////////////////////
+double distance_cosine(const VectorXd& u, const VectorXd& v)
+{
+    return (1 - u.dot(v) / std::sqrt(u.dot(u) * v.dot(v)));
+}
+
+double distance_euclidean(const VectorXd& u, const VectorXd& v)
+{
+    VectorXd d = u - v;
+    return std::sqrt(d.dot(d));
+}