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"
ReedsSheppStateSpace rsss(10.82); // TODO const param
return static_cast<float>(rsss.distance(q0, q1));
}
-
-#endif