Add missing `cco3` function

[hubacji1/iamcar.git] / vehicle_platform / cost.cc

diff --git a/vehicle_platform/cost.cc b/vehicle_platform/cost.cc
index 92b22f6b11dba1aa2351d9848850454774a4cd9f..51a971b31e48426f5affceaca0060c5ca36d0382 100644 (file)
--- a/vehicle_platform/cost.cc
+++ b/vehicle_platform/cost.cc
@@ -91,3 +91,8 @@ float co3(RRTNode *init, RRTNode *goal)
         }
         return rsdist + edist * cnt + 1 / (1 + init->ocost());
 }
+
+float cco3(RRTNode *init, RRTNode *goal)
+{
+        return init->ccost() + co3(init, goal);
+}