X-Git-Url: http://47.100.26.94:8080/?a=blobdiff_plain;f=src%2Fhungarian.cpp;h=7c1d8dad45447bd0c89d7e4a40810f3b90960f7c;hb=3ff9a5ad691b8dca9d91f8e9786a8d08d31b70fa;hp=85b49e508bdcede372009cf2a3a566902242fb35;hpb=0d625404c2ef4a286e1feee4485ff60c0fb9730e;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));
+}