Fix cost code (not a header file)

diff --git a/vehicle_platform/cost.cc b/vehicle_platform/cost.cc
index 81a3edb08415f4f55eb3d9a8f1759a37ee4c86b7..be713943b8104b6de3fb6d323579ff09f1354acd 100644 (file)
--- a/vehicle_platform/cost.cc
+++ b/vehicle_platform/cost.cc
@@ -15,10 +15,8 @@ You should have received a copy of the GNU General Public License
 along with I am car. If not, see <http://www.gnu.org/licenses/>.
 */
 
-#ifndef COST_H
-#define COST_H
-
 #include <cmath>
+#include "cost.h"
 #include "reeds_shepp.h"
 #include "rrtnode.h"
 
@@ -36,5 +34,3 @@ float co2(RRTNode *init, RRTNode *goal)
         ReedsSheppStateSpace rsss(10.82); // TODO const param
         return static_cast<float>(rsss.distance(q0, q1));
 }
-
-#endif