Add cost to JSON output

diff --git a/base/main.cc b/base/main.cc
index a2ddac2ea3965050e0e0a5098e022e7f9dfa1bd3..ebdb9b9c03c73d1b510c1cc68e4fdd171314c7b3 100644 (file)
--- a/base/main.cc
+++ b/base/main.cc
@@ -77,6 +77,9 @@ int main()
         Json::Value jvo; // JSON output
         unsigned int i = 0;
         unsigned int j = 0;
+        // log cost
+        for (j = 0; j < p.clog().size(); j++)
+                jvo["cost"][j] = p.clog()[j];
         // log traj
         i = 0;
         j = 0;