Add sign template

diff --git a/incl/rrtnode.h b/incl/rrtnode.h
index 5bc5f810a7a170d13ee046f66698b78695809410..70979a9dbfb4c24488ad791db45d6a050302000e 100644 (file)
--- a/incl/rrtnode.h
+++ b/incl/rrtnode.h
@@ -26,6 +26,10 @@ along with I am car. If not, see <http://www.gnu.org/licenses/>.
                                 pow(_b->y() - _a->y(), 2), 0.5) < 0.2 && \
                 std::abs(_b->h() - _a->h()) < M_PI / 32 ? true : false; })
 
+template <typename T> int sgn(T val) {
+            return (T(0) < val) - (val < T(0));
+}
+
 class RRTNode {
         private:
                 float dcost_ = 0; // direct cost (of edge) to parent